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Chapter 1 

AN OVERVIEW OF 
THE MULTIPLE POINTING-MOUNT 
SPACE PLATFORM CONTROL PROBLEM. 

u c r ~ involving ins trument P Qjptint ad SIW1P 8 Motions 

A number of space-based scientific experiments planned by NASA for the near future 
wffl involve instruments that are required to continually point accurately at various objects 
in space and/or locations on the earth's surface. Still other experiments will be required to 
perform carefully controlled back-and-forth slewing motions and thereby scan various regions 
of space and/or the earth's surface, looking for characteristic features of certain phenomena 

being studied. 

In order to accommodate many such experiments, in a cost-effective manner, NASA 
has conceived the idea of a multiple pointing-mount space platform ( hereafter referred to 
as MPMSP) on which a variety of such experiments would be mounted and operated 
simultaneously, Fig. 1.1. This MPMSP would act as a common chassis, or framework, to 
which the various moving and non-moving equipment modules associated with each 
experiment would be attached. In addition, solar power collector panels, and telemetry 
mat transmit scientific data and receive uplink commands associated with each 
experiment, will be attached to the MPMSP. The proposed Geostationary Earth 
Observatory (GEO) project, Figure 1.2, is one specific example of an MPMSP application. 
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Fieure 1.1 Concept of a Multiple Pointing-Mount Space 
Platform (MPMSP). 
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Figure 1.2 


Specific Example of an MPMSP; the Proposed 
Geostationary Earth Observatory (GEO). 
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12 r^nflirt and Antaponis m in Distributed Multi-CoptroUer Systems 

The individuaJ pointing and slewing experiments mounted on an MPMSP will each 
be controlled by its own individual (local) controller, which will be designed to achieve and 
maintain the pointing or slewing requirements for that particular experiment. This family of 
local controllers comprises what is called a (spatially) distributed multi-controller system. The 
design of these local experiment controllers will probably be carried out by a variety of 
different vendors (design teams) working independently, and win involve consideration of 
the uncertain disturbance motions and/or vibrations of the common platform-framework 
by equipment movements associated with other experiments that are operating 

simultaneously. 

A sometimes overlooked subtlety of such a multiple-controller arrangement mounted 
on a platform is that the platform base-motion disturbances felt by any one 

experiment are not conventional nmdom-like exogenous inputs, but rather, are functionally 
related to the contwlier feedback actions of all the other individual experiment controllers 
mounted on the same platform. As a consequence of this subtie fact, the otherwise well- 
designed experiment controUers can become antagonistic to one another in the sense that 
the control actions of any one controller become the "disturbances" that the other controUers 
must react to. The latter set of controUer reactions, in turn, is reflected back as 
"di st ur bances ” to the first controUer, thereby triggering an action-reaction-action "vicious 
circle" which can , under appropriate conditions, lead to the sudden, unexpected onset of chaos 
and instability of the whole platform system. This system instability behavior is not dependent 
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on structural flexibility effects and can happen even though each equipment controller ts, 
individually, quite stable. In such a situation, the otherwise desirable responsiveness ot 
individual experiment controllers causes them to begin "fighting" each other, as if in conflict. 

A familiar example of this phenomena is the tragic consequences of seemingly innocuous 
pushing and shoving in a large, tightly-packed crowd of people, (here each person acts as 

an individually controlled element.) 

L3 of Multi-Controll er Conflic ts and Antagonisms 

The early recognition of the inescapable controller conflicts and antagonisms, and the 
real yossSoi^es of their suddenly triggering violent system instabilities, in the distributed 
multi-controller environment of a multiple pointing-mount space platform (MPMSP) should 
be considered as a major design and safety consideration for any MPMSP project. The 
importance of this cons.deranon arises from the fact that the individual dynamic 
characteristics (i.e„ settling-times, damping factors, etc.) of each individual experiment 
can have a critical influence on the stability of the overall platform system. A 
seemingly beneficial "re-tuning" of the controller "gains" associated with any one of those 
"indiv iduall y stable" experiment controllers could, conceivably, trigger instability of the overall 
platform system, when in space. In fact, even a spatial relocation or reorientation of the 
mounting points for the moving equipment associated with an individual experiment module 
could, conceivably, trigger an instability of the overall platform system. 

The unsettling aspect of this controller-induced destabilization phenomena is that. 
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owing to the inherent nonlinear nature of the overall system dynamics, the instability can. 
and usually will, be dependent on the occurrence of certain critical combinations of 
H p^n.rie and kinetic conditions among the conflicting controllers and their respective 
ex periments. Thus, the MPMSP system could, in fact, function quite well for some extended 
period of time until those critical dynamic conditions just happen to occur. Then, without 
warning, the whole platform system could suddenly become unstable. 

There are primarily three approaches to managing multi-controller conflicts and 
antagonisms in MPMSP’s. One approach consists of limiting the simultaneous operations of 
experiments to those that involve a negligible degree of conflicting control actions. This 
approach can lead to "one-at-a-time" operating scenarios. Another approach consists of re- 
designing the family of independent experiment controllers to work in a certain strategically 
coordinated manner that automatically mitigates excessive conflicts between controllers. This 
orchestration approach forces one to give up the individuality of the experiment activities, 
and imposes a hierarchical, centralized control-authority structure that can be quite complex 
and involve extensive communication links between the family of experiment controllers. 

The third approach, which is the one considered in this study, consists of using a 
platform controller to impose a high-degree of "quietness" of the platform structure while the 
experiments are operating simultaneously. That is, the platform controller is designed to 
effectively suppress movements and vibrations of the platform due to the disturbances 
caused by experiment activities; see Figure 1.3. This maintenance of a "quiet platform." in 
the face of complex disturbance forces and moments induced by experiment pointing and 
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slewing motions, essentially breaks the "vicious circle” that allows one controller s action to 
be felt as a disturbance by the other controllers, and vice-versa. This mediating action 
clearly requires an exceptionally fast-acting and versatile "disturbance-adaptive” platform 
controller. Modem control theory has provided an extensive design methodology, known 
as Disturbance-Accommodating Control (DAC) Theory, for designing such disturbance- 
adaptive controllers and that theory will form the basis for the platform controller design 

developed in the present study. 

14 ^m pe of This R esearch Effort 

This research effort is directed at developing a new control concept that could form 
the technology basis for designing a high-performance platform controller for MPMSP-type 
projects. Because the present effort is directed at developing a control concept, and 

the credibility of that control concept, a highly simplified, planar-motion 

3(rigid)-element, multi-body model of a generic MPMSP has been adopted as the basic test- 
bed model for designing and demonstrating the proposed platform controller concept. Of 
course, any attempt to use the concepts and methodologies described herein on a real 
MPMSP project would necessitate consideration of the inevitable flexibility and out-of-plane 
motions of any real space platform, as well as the torque limitations of any realistic platform 
controller actuator. Nevertheless, the new platform control concept presented here is 
considered to be an innovative and viable candidate for consideration in any realistic design 

of a MPMSP. 
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Chapter 2 

A 3-LINK MULTI-BODY GENERIC MODEL OF 
A MPMSP IN PLANAR MOTION 


2 i " fii* Idea nf n Concent -Dcn » ation Model 

to Control Engineering, the initial development and effectiveness demonstration of 
a new control concept is typically conducted using simplified, low-order plant models (called 
"concept-demonstration" models) that permit one to focus attention on, and understand, the 
basic features of the control system behavior without being overwhelmed by dynamic 

r wi.« of the plant model, to this chapter we propose a concept-demonstration model 

of a generic multiple pointing-mount space platform. This model is a highly simplified, 3 
(rigid, ptojointed>link representation of the dynamic features of an MPMSP, moving to 
piowar motion. Although it is highly simplified, this model embodies the essential features 
that make the platform control of an MPMSP a challenging problem, to Chapter 5 of this 
report, the effectiveness of the proposed platform controller concept will be demonstrated 
by computer simulation exercises, using mathematical models of the concept-demonstration 
model and the platform controller. 

2.2 a 't.T inlr fieneric Mod ^l nf a MPMSP 

The five essential features of an MPMSP platform control problem, from the control 

theoretic point-of-view, are: 
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1. A platform upon which two or more independent experiments are mounted. 

2. Each experiment involves the pointing or slewing of equipment 
(telescopes, sensors, antennae, etc.) that has significant mass and/or rotational 

inertia. 

3. The pointing/slewing motion of each experiment’s equipment is controlled by 
its own individual (local) control system, designed for that particular 
experiment, and operated autonomously in accordance with the individual 
needs of that particular experiment. 

4. The controlled equipment motions associated with each experiment induce 
reaction forces and/or moments on the platform. 

5. The local control systems for pointing and/or slewing each experiment are 
designed to cope with uncertain-type "base motion" disturbances that arise 
from vibrations and transient motions of the platform mount. 

Feature #4 implies that the angular (and linear) momentum vectors associated with 
equipment motions Ho not remain invariant during such motions. This feature occurs 
naturally in most equipment, except in those special cases where the equipment incorporates 
specially designed, "counter-inertia," mechanical assemblies that contain controlled, motor 
driven, counter-rotating inertia disks, which effectively cancel-out the angular momentum 
changes that would otherwise occur when, say, a heavy instrument is rotated in ns mount. 
Indeed, if all equipment motions on an MPMSP were accompanied by such "counter-inertia" 
devices, there would be no platform disturbances or controller conflicts to contend with...but 
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there would then be a significant increase in cost, weight, equipment complexity, and system 
power consumption. Feature #5 is a common control system requirement for any precision 
pointing/slewing experiment mounted on a space platform, and typically leads to the use of 

some form of "integral-feedback" in the controller. 

Any space platform big enough to be used as a mounting base for multiple 

npert will involve some structural flexibility. This latter feature has not been included 

in the above list. The reason for this omission is the quantum increase in modeling 
— T-Winn, and model complexity that such flexibility considerations would email. 
Specifically, consideration of torsional flexibility would force consideration of coupled out-of- 
plane motions, which would lead to the modeling of 3-dimensional dynamics-a complication 
that would exceed the resources budgeted for this project Moreover, inclusion of the 
platform's in-plane, lateral flexibility would add enormous complications to the already 
difficult task of developing the exact equations of in-plane motion of the "simplified concept 

demonstration model. (See Chapter 4 of this report.) 

The simplest configuration of mechanical elements that embody the five essential 
MPMSP features listed above is shown in Figure 2.1 and consists of three co-planar ngid 
links, pin-jointed together as shown. The center link represents the space platform, together 
with the non-moving experiment equipment, while the two unsymmetrical, but co-planar, 
end-links represent respectively, the pointing/slewing equipment associated with two 
jn d . p~.rtcm experiments, which are presumed mounted at either end of the platform. The 
(co-planer) rotational movements of each end-link, with respect to the platform, are assumed 
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t0 be controlled by an tndependen, motor, or toque device (totquet), located at each pin- 
join, connection, and such that the controlled torques exerred on each end-link (on each 
experiment equipment) results in an equal-bu, -opposite reqptipp totffi e exerted on the 
center link (on the platform), Tire entire assembly shown in Figure 2.1 is assumed to be 
positioned in space, moving in (locally) planar-motion, in an essentially zero-gravtty 
environment (e.g. in orb,, around the earth). Thus, in the course of mathematically 
m ~t.i,n; the dynamics of the "configuration model" in Figure 2.1, one can ignore the usual 
gravity forces that would be tmagined, say, as acting through the centers of paviry of the 
respective links. However, it may be necessary to include in that mathematical model the 
xnraB, but persistently acting, "gravity-gradient torques" .hat wUl acton such an assembly tn 
orbit Our exact dynamic mathematical model of Figure U. developed in Chapter 4, will 
include a generic "external dtsturbance torque" term T e to account for such gravtty gradten, 

torques, as well as solar-pressure effects, etc. 


2.3 jbe P^tfnrm C ontrol Problem for the 3-1 ink Model 

The platform, or center-link, in Figure 2.1 is assumed ,o contain its own "platform 
torquer device" (e.g. a GM.G. device) that can be continued to exert precision, quick-acting, 
in-plane torques T c on the platform as determined by the platform control algorithm. (The 
design of this platform control algorithm is the main task of this research effort.) The 
locations of the centers of gravtry, as weU as the mass and rotational inertia-values of each 
unk shown in Figure 2.1, are considered to be completely arbitiary in this study. 
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In long-range pointing tasks, such as envisioned for experiments on an MPMSP, 
angtdar pointutg errors due to platform angular base-motion disturbances are far more 
serious than errors associated with platform rectilinear base-motion disturbances. Thus, in 
accordance with the "quiet platform” approach to be used in this study for controller conflict 
(the third approach cited in Chapter 2), the task of the platform controller is to 

achieve and maintain the "quiet" angular condition 


in the face of arbitrary angular motions 6,(t) , 0 2 (t) of the two end-links shown in Figure 
2 . 1 . Moreover, the motions 9 1 (t), 0 2 (t) are assumed to be controlled by independently 
acting controllers in accordance with the real-time requirements of each experiment (each 
end-link); see Feature 3 in Section 2.2. 
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Chapter 3 

design of a disturbance-adaptive mpmsp control 
strategy for the planar motion generic model 


The controller design methodology used in this chapter is based on the theory of 
Disturbance-Accommodating Control (DA C). We begin with a brief tutorial revtew of the 

principles of DAC theory. 



The theory of Disturbance-Accommodating Control UH4I «“> n °”- 

statistical modeling and controUer design techniques for systems subjected to uncertam, 

„ isnr ablc, time-varying, multi-variable disturbances w(t) = (w,(t), w 2 (t), .... w p (t)). 

In the remainder of tins chapter we will focus on the special case p=l of an 


equivalent scalar (single-tnput) disturbance «(.); see [2] for demils of the theoiy for vector 
P >1. The central idea in DAC disturbance modeling is the concept of a 
^orm model, which is simply a representation of w(t) as an unknown weighted linear 

combination of completely known bosis-funenom (f,(t), f 2 (t), -£„,«> of the form 

w (t) = CjfjCt) + ^2 ^2 ( ^ ) + - + 

where the (C„ C, C m > are scalar weighting coefficients that are completely unknown 


“constants", which may occasionally jump in value in a once-in-awhile manner. Thts sparse 
jumping behavior of the "constants" q is referred to as “stepwise-constant" behavior and 
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is illustrated in Figure 3.1. Durban** that ean be effectively represented by an express, on 
of the form (3.1) are said to have wavefom-mucmre; those that cannot are referred to as 
uutsa disturbances. The waveform-mode, represent (3.1) is a generahzed sphne- 
function model as used in appmnmonon theory , and can be viewed as an extension of the 

idea of a Fourier-series representation. 

The collection {£,«> of presumed known basis functions in (3.1) is chosen by the user 

,o reflect the actual patterns of w(t) time-behavior as seen in experimental data. etc. Thus. 

if w(t) characteristicafly exhibits a sinusoidal pariem of behavior, with known frequency . 

and wtiuMwn stepwise-constant amplitude and phase, one would write (3.1) as 

w (t) - Cj sin «t + C 2 cos <at 

Utewise, if the uncertain time-behavior of w(t) has the generic piecewise-Bnear (step plus 
ramp) characteristic as shown in Figure 3.2, one would write (3.1) as 

.(O-qirCjt (3-3) 

1„ some industrial applications, the characteristic time-behavior of w(t) is rather 
varied and undistinguished, as shown in Figure 3.3. In such cases, an effective chotce for the 
basis-functions {f*(t)> is the polynomial basis-set (l,t,t% .... ' <ml) >- Hie corresponding 
representation (3.1) then becomes the potynomial-splme waveform model 

,(,).c 1 i.q.*^...*c 1 .'- ,) ' (3 - 4) 

vrtUch is usually quite effective in modeling slow, meandering-type functions w(t), even when 
one chooses the relatively small value m=3, (the stalled puadraac-spUne model). 
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Figure 3.1 


Stepwise-Constant Time-Behavior of the 
Weighting "Constants” in (3.1). 
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Figure 3.2 An Uncertain Disturbance w(t) Have Piecewise- 
t inear (step-plus-ramp) Time-Behavior. 



Figure 3.3 


An Uncertain Disturbance w(t) Having 
Undistinguished, Meandering Time-Behavior. 
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3 2 of a a amiana Waveform Model lo a State Mod e] 

Tht design of a DAC controller is based on the technique of on-line identificanon 
of uncertain disturbances havtng waveform-structure [2,. Hus on-lrne identificanon of 
attain disturbances w«) is accomphshed by a conventional smte-observer or Kalman 
fiter, which processes the system control input u(t) and output measurement y(t) data to 
p^ooe accurate real-time estimate w (t) of tite actual dismrbance input w(t). To do 
this, i, is necessary to have a differential equation mode, of the waveform behavior of w(t). 
That is, one must find a differential equation for which (3.1), with constant q, is the (a) 
aohition. to practice an effective choice of basis-functions «<)> can usually be found in the 
„f functions that satisfy some toeartime— n, ®er=ntial equation; expressions 

_ mmniM of such In such linear cases, the differential 

(3.2), (33), (3-4) are common examples oi suen 

equation corresponding to (3.1) will have the form 

dP - 1 


dP 


w 


W 


dt? 




(3.5) 


where p and the (U, ,P 2 , ~ , V are completely d«emdned by toe (known) basis funenons 
{ f l( t), ... q(t)}. For instance, in the case (3.2) toe corresponding differential equation 

model (3.5) is 


d 2 w 

1? 


w = 0 


Likewise in the case (3.3) expression (3.5) becomes 

5^ -o, 
dr 


(3.6) 


(3.7) 


and for (3.4) the counterpan of (3.7) is 
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d m w 


= 0. 


(3.8) 


dt 


m 


The observer, or Kalman filter, used to generate die disturbance estimate w(t) requtres that 
pj) be re-written in the form of a smte-variable model. The general form of such a linear 

disturbance state-model for a scalar disturbance w(t) is 

w . h T z; h^ » P - vectors 1 ( ■ ) T - denotes transpose P£) 

4 =Dz + ff(t) ; D - pxp matrix 


(W» can be chosen as any one of die canonical completelyHtbservable pans 

t 2;pg.418]. The tenn e(«) = (<r,(t), - . .,(«)) * <W «— 8 ° f ' 

sparse sequences „,(«) of Diracunpulses, which arrive in a random, once-in-a-while manner 

^ unknown intensities. The unknown impulses of o,(«) represent the "cause" of the once- 

in-a-while jumping of the C, as shown in Figute 3.1. Note dta. o(.) in (3.9) is a* 

noise" as is commonly used in stochastic control theories. The constant matrix D to (3.9) 

embodies the collection of basis functions (f,(«)> as characmristic eigenfunctions of D. Thu, 

D may be an jflBSMe matrix, even though w(t) in (3.9) always remains bounded. In DAC 

theory, the p-vector z-(z„ .... z„) is called the note of the disturbance w(t). 

To illustrate the ptocedure for developing a sum-mode, (3.9), consider the 

differential equation model (3.6). If we define the disturbance state-variables (z„ z,) for 


(3.6) as 


= w : Zo = w 


(3.9c) 
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then, clearly 


/ ^ 

*1 

*2 , 


0 1 
2 


-O) 


0 


( \ 

Z 1 

*2 J 


o 2 (t) 


( \ 


; w = (1,0) 


(3.9d) 


m-a- 


wherc the sparse impulses of o,(t), o 2 (.) account for the unknown random-like once-, 
while jumps in w(.) and/or *(«), cmresponding to jumps in C, and C, in (3.2). 

3J ^ | .H^ntifieation -f ~ fi) - ■ E m 

The next step in DAC controller design is to incorporate (endogetuze) the 

disttnbance state-model (3.9) with the plan, state-model For this purpose, suppose, for 
simplicity, dm. the plant with scalar disturbance is represented by a linear, nme-tnvarian. 

state-model of the form 

x = Ax + Bu +fw ; u = r-vector control input, (3.10a) 

y = Ox ; y = m-vector output measurement, (3.10b) 

The disturbance state-model (3.9) may now be incorporated into (3.10) to obtain the 

following composite plant/disturbance state-model 


a) . 

A 

|fh T 

Ur 

O 

1 d] 


m-isr-bsy 


(3.11) 


which can be written in the compact form 

* s Ax Bu ♦ a 


(3.12a) 


= C x 
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where 


•m-' 


A = 


A |fh T 
O ID 


B = 


B 

0 


; C = [C 1 0] ; a = 


0 

a(t) 


(3.12b) 

A standard full-order, or rcduced-order, obsener can now be designed to generate 

real-time estimates » Win (3.12). Alternatively, if the plan, measurement y(.) * (3.10b) 

contains additive "measurement noise" of the form 

y = Cx+r?(t) , r?(t) * measurement noise ( 3 - 13 ) 

one then can use a standard Kalman filter to generate the real-time, mnnmum-square-error 

r r . J (t) . In either case, the corresponding distiirbance estimate w(t) is obtained 

/ \ 


as 


w(t) = h T z (t) = 1° l h ] 


A 

X 

A 

l Z 


cT J 
» h x 


(3.14) 


To demonstrate this observer design methodology, recall that a full-order observer for 
(3.12a) has the well-known form [2; pg. 432] 


y(t)-C x 


(3.15) 


£ = A x + Bu - Kq 

where the observer gain matrix ^ is designed to make the estimation error e = |x - x 
ra pjdlv approach zero between arrivals of the sparse, unknown impulses of o(t). It is easy 
to show from (3.12), (3.15) that, between impulses of a(t), c(t) obeys the vector matrix 

homogenous differential equation ^ ^ £ (3.16) 

Thus, to make e(t) - 0 promptly, K, should be chosen to place the eigenvalues of 
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A + Kq C 


sufficiently deep in the left-half of the complex plane. 


3 4 P^iau of the PA r Control Law 

In DAC theory, there are a variety of ways a control system can "accommodate" the 
disturbances w(t) that act on a given plant. The most common meritod of accommodation 
is to design the controller to exactly coumerac, (reject) the total effect of w(t) on the plan, 
smte x(t). To accomplish tins, we first agree to split the total control effort u(t) into 


two 


parts 


(3.17) 


u = Up + U d 

^ t^ wffl be designed to exactly cancel the disturbance effecs on x(t) and where u„ is 
then 


designed to accomplish the primary comrol task (set-poim regulation, setvo-tracking, 
etc.) for the umiistmbed plant. If the plant state model is given by (3.10), the incorporation 

of (3.17) yields 

x = Ax + BUp + Bu d + fw(t) (3 - 18) 

Thus, to completely cancel w(t) in (3.18), one should design u d to satisfy 

B u d = -fw(t) = -fr 1 Z W ’ 2e EP (3 ' 19) 

condition for existence of a solution u d to (3.19) is the total 

(3.20a) 


The necessary and sufficient 
cancellation condition [2]. 

which implies 


rank [B|f] = rank [B] 


f = By 


(3.20b) 


for some (possibly non-unique) vector y. 


Assuming (3.20) holds a control u d satisfying 
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(3.19) is given (ideally) by u = . yz ( 3 - 21 ) 

ta practical applications, the term z(t) tn (3.21) would be replaced by the real-time estimate 
i(t) obtained from a real-time observer or Kalman filter (3.15). If condition (3.20) fads to 
bo satisfied, it is impossible for the control action to cancel-out all the effects of w(t) on x(t). 
In urn. ease, there are a vanety of alternative modes of disturbance accommodation one can 

consider, such as "disturbance minimization;" see [2]. 

u, can be designed as in (3.21), the remaining part u,, of u can be designed 

to accomplish the pnmary control task, using conventional design methods and setting Bu d 
+ fw(t) ■ 0 in (3.18). This is a well-known standard procedure in modem control theory. 


This completes our brief tutorial review 


of DAC principles. We will now apply those 


principles to the platfotm controller design for the generic MPMSP model developed in 
Chapter 2. 


3.5 TT.. im nf A nisrurba r - Eajffljtai for the MPMSP Qfflfflc Modd 

The uncertain disturbances associated with the platform control of an MPMSP are 
ideally suited for representation by a waveform-model (3.1). To see this, recall the 
arrangement in Figure 2.1 and consider the corresponding platform 'Tree-body dtagram" 

shown in Figure 3.4. 
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The disturbing forces and moments that act on the platform consist of: 


( 1 ) 

(«) 


the pin-joint reaction forces associated with the movements of each end-link, 
the torque reactions associated with local controller torques that act on each 
end-link, at the respective pin-joints, and 

(iii) the external torques that act on the platform through the effects of gravity- 
gradients, solar pressures on the solar collectors, etc. 

, nf Fimire 3 4 it can be seen that the basic Newtonian equation 

Referring to the geometry ot rigure u ***» 

governing platform angular dynamics 

(pi £ ( torques) cg = J cg 4 


(3.22) 


has the specific form 


-T r T 2 + F 2 N £02 + F 1 N t 0 i + T e + T c - J C g * 


(322b) 


where 


T!,T 2 


= local controller torques that act on each end link to control the 
experiment equipment motions S^t), 0 2 (t) 

= platform controller torque 

= net external torque on platform due to combined effects of 
gravity gradients, solar pressures on the solar panels, etc. 

= the components of the pin-joint reaction forces that act on the 
platform rad are normal to the longitudinal axis of the platform 

_ distances from the pin-joints to the platform center of gravity. 

In order to design an effective, disturbance-adaptive platform controller, T c = T c (?), 

i, is important to decide whtch torque-.erms on the left side of (3.22b, are likely to behave 

as "uncertain disturbances"; te- torques that are not reliably known and/or not directly and 


FlN’ F 2N 


* 01 ’ *02 


UAH / ECE Dept / Dr. C. D. Johnson 


12 


Chapter 3, Final Report 



A Multiple 


Pointing-Mount Control Strategy for Space Platforms 
NAM-36955 / D.O. 110 


reliably measurable (in real-time), in a realistic MPMSP proieer. As will be shown m 

Chapter 4 [see Eqs. (4.1), (4.3)], the exact mathematical expresses for the normal 

components F lN , F 2N of the pin-join, reaction forces are incredibly long and comphcated 

functions of <*, 4, i e„ e„ e„ J, M, etc.) thereby rendering foe accurate on-hne 

compulation or measurement of F 1N (t), F^t) rather impractical. The local controller 

torques T l( t), T 2 («) should be relatable to foe electrical current in foe respective torque 

motor . However, foere may be some degree of liability (or excessive risk) in using such a 

/ T m T / t u ^ real-time. Thus, in this study, we elected to consider 
scheme to measure Ui(t), m 1CU1 

(-Tj(t), -T 2 (t)> as uncenain, unmeasurable reaction torques acting on foe platform. 

The inherent uncertamty as to foe exact kinematic configuration of all foe movrng 
parts of all foe experiments, soh.r-p.nels, antennae, etc, mounted on foe MPMSP, suggests 
tha, foe time-behavior of the gravity gradient and solar pressure torques would be difficult 
ro compute on-line or predte. c priori, and should, therefore, be mewed as uncertam. 

unm easurable disturbance torques. 

!„ summary, for this study, we will adopt foe "worst case" in regards to the ability to 
measure disturbances; namely, foe total net uncertain,unmeasurable disturbance torque T(1 (t) 

acting on foe platform in Figure 3.4 will be defined as: 

T d (t) a - T|(t) - T 2 (t) -hFjNft) 402 + Fin(‘)4oi + T e (3 - 23) 

In view of (3.23), expression (3.22b) can be written as 

T + T = J c „ <(• (3.24a) 

A d ^ A c eg ^ 
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3.5.1 A Subtle Far t About (324a): 

Owing to the fact that the reaction forces F 1N (-), F 2N (0 in (3.23) contain terms that 
are explicit functions of the platform angular acceleration i it is neeessary, for controller 
design purposes, to write (3.24) in the modified form, 

T i + T c = V (3 ' 24b) 

where T d denotes the remainder of T„ after the ^-related terms of T d have been removed 

from Te and combined with the right side of (3.24a) to augment the "effective" J cg and form 

tf,e new expression^. (Note thaU cg in (3.24b) is typically a nonlinear function of <4>, *, 8 ,. 

8 A if mis step is not invoked, me design of a disturbance estimator as descnbed below 

„«omes extremely difficult. Hus is a rather unusual and potentially confusing consideration 

m DAC theory that has not been heretofore discussed in the literature. With respect to me 

augmented merna model (3.24b) the platform control problem is to estimate and 

cancel the term T d (t) and regulate *(t) - 0. 

3 j 2 Waveform. Characterization of T d 

■me various physical sources which create or originate the components of T„(t) . as 

m pab). are all characterized as producing essentially smoothly evohnng, dynamic 
torques with the possibility of simple jump-behavior occurring once-in-awhile, (due, for 
instance, to sudden reversals of the local controller's torque motors, etc.). Thus it can be 
that a typical time-plot of T d (t) would be as shown in Figure 3.5. me genenc 
meandering behavior of T„(t) shown in Figure 3.5 suggests in general that T„(t) may have 
a waveform structure in which no distinguishing periodic, or other specific basis functions. 
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are apparent. This case is one in which a polynomial-spline waveform model of the type 
(3.4) is appropriate. Thus, in the interest of keeping things simple, our first trial design ot 
the platform controller will be based on modeling the uncertain time-behavior of T„(t) by 
the quadratic-spline waveform model 

T „(t) = C, + C, t + Cjt 2 (3-25) 

where the "constant" coefficients <C„ C,. C, > in (3.25) are allowed to jump in value in a 
sparse, once-in-a-while manner (= "stepwise 3.6 - constant"); see Figure 3.1. 

The model (3225) is capable of emulating a rich variety of meandering uncertain 
(hsturbance behaviors such as shown in Figure 3.5. In feet, the waveform model (3.25) can 
■effectively emulate T„(t) behavior containing "slow," unknown sinusoidal components, 
unknown asponential components, etc, provided the associated unknown frequencies, time- 
constants, etc. are sufficiently "small;" see the "disturbance estimator" performance plots in 

Section 3.7. 

A disturbance state-model (3.9) corresponding to (3.25) is developed as follows. First, 
define the three disturbance state-variables z 1? z^, z 3 as 

i (3-26) 

a, - T d ; *2 - T d ; 2 3 - T d 

Then, note that, for constant C: 

Zj = Zri(= Cj - 2 Cjt ) ; *2 = z 3 ( =2C 3) ’ ^3 = 0 ’ h21) 

Thus, letting the random-like aj(t)-impulses account for the sparse jumps that occur in (Cj 
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G,,^), one can 


write (3.27) in the form of (3.9) as 


T rt = (1,0,0) 


f \ 

Z 1 

*2 


(3.28a) 


/ \ 

Zi 


0 1 0 


f \ 

Z 1 


®i(t) 

1 

Z? 


0 0 1 


^2 

+ 

o 2 (t) 

L 

Z3 

V J J 


0 

0 

0 


V 




(3.28b) 


on-line esnmanon NT*) in 0.24), from the assumed available on-line measurements 
of mi T c (t)} is accomplished by use of a composite sta.e-observer of the type (3.15). For 
purpose the composite plant/dismrbance model (3.11) is obmined torn (3.24b), (3.28) 

as follows. The plant state variables can be defined as 

x 1 = <t> ; *2 = * 

Then, the corresponding plant state-model (3.10) becomes 


/ \ 


0 1 
0 0 


t \ 

X 1 

x 2 


( o 
j c g 


\Tr 


0 

] -1 

J cg ) 


(3.29) 


(3.30a) 


y = = (1,0) 


t N 

X 1 

x 2 


(3.30b) 


Combining 


ining (3.30) and (3.28) then yields the composite state-model (3.11) as 
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' *1 ' 


0 

1 

0 

0 

0 

/ 


0 

0 

r 1 

0 

0 


*2 


eg 




Z 1 

= 

0 

0 

0 

1 

0 


h 


0 

0 

0 

0 

1 


1 V 


0 

0 

0 

0 

0 

V 


*1 
x 2 
Z 1 

*2 
^ *3 


o 

J _1 

eg 

0 

0 

0 


y » <p * (1,0, 0,0,0) 


*1 
*2 
*3 J 


0 
0 

02^) 

03 (f) J 


(3.31a) 


(3.31b) 


The -full-order compos-state observer (3.15),xone^xmdmg to (3 31), eer. rrow be wmen 
uutiniull as Xi - ^2 “ ^01 (y ”^i ) 


*2 * ^cg 


- 1 1, 


-ko3(y-*i) 

Z 2 « Z 3 - ko4(y- x l) 

i 3 - -kos (y- x i) 

and the associated estimation-error dynamics (3.16) is given by 


(332) 
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' *1 ' 
h 

*3 

u 

€5 


0 1 0 

r 1 

0 0 J cg 



0 0 0 
0 0 0 
|o 0 0 


0 0 


k 01 ' 

■(1.0.0.0.0) 

0 0 


k 02 


1 0 
0 0 

+ 

K 4 * 
o O 

4k U> 


0 0 


^05 ' 



f 61 ] 

€ 2 

€ 3 

e 4 

l €5 J 


( 3 . 33 ) 


3ms, in accordance with theTcmarksbelow (3.16)-thedesigner should choose the observer 
irn" {koi. *02*11' ^04- k 05> ta (321) Kr P lace " t he'five eigenvalues U 01 , W03. x w- 




of she composite matrix 


[A *£oC] 


ho, 1 o 00 
*02 0 J c'g 0 ° 

Jifl, ° ° 10 

Jf04 0 0 0 1 

Jtflj 0 0 00 


(3.34) 


sufficiently deep in the left-half of the complex-plane. 

The characteristic polynomial P(X ) of (3.34) is easily calculated to b 

p(X) . X 5 -*01 - fc 02 * 3 - k 01 Kg x2 -*04 Kg *- k 05 



( 3 . 35 ) 


Now suppose thedesuwf values of the five eigenvalues X oi of (3.35) are denoted by U„ * 2 . 
ij, X 4 , X S ). Then the corresponding desired characteristic polynomial P d (* ) for (3.34) can 

be computed by the formula 
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t>tW 


( X - Xj ) * ( X - X2 ) 
X 5 + a 5 X 4 + a 4 X 3 


( X - X 3 ) * ( x - X 4 ) • ( X - X 5 ) (3.36a) 
a 3 X 2 + a 2 X + a! (3.36b) 


^ foe (a,) will be precisely determined by the desired values of the U,> It is t>°w a 
simple mtatter .0 equate conesponding xoefBcients in (335) and (336b) ,0 obtain the 

following expUcit design formulae -for the -observer gains (koil- 

k oi - ” °5 


k 02 * ” “4 

k 03 * ” ^cg a 3 

k 04 * " ^cg “2 

--JcgOj ; 04 -pvcnby (336b) 


(3.37) 


Theset of equations (332)sogefoer^tbe:gam formulae (337) constitute the complete 
for the disturbance-identifier ^estimator) for this generic MPMSP-problem, where 


Id -M 1 ) 


(338) 


3 6 p^ipi nf a njrtnrbanc r -^yfapt^ Controller forthp MTMSP <foflcrre M odel 

The rotational motions *(t) of the platform (center-link) in the MPMSP generic 
-model -shown in Figures 23 end 3.4 are governed by the ineriUHangmented Newmnian 
equation of motion (334b) where T t is defined as font par, of (3.23 ) font does no, depend 
explicitly on *, and where the T„(t) waveform is modeled by (335), (338). As stated m 
Chapter 2 see Equation (2), the task of the platform controller T c is to achieve and 
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Platforms 


to "quiet" angular condition *(«) - 0, «t) * Ota Re face of all expeaed external 
torques T e (t) and arbttrary motions 0,(1). 6 2 (t) of the experiment equipment (the end Unto ). 

Using the standard control engineering symbolism 

u = control-input = T c ( 3 - 39 ) 

in (3J4), together -with she standard DACxontro>*p^g technique (3.17), one obtatas 

P34b)m the -form — _ y.,,411) < 3 - 40 ) 

DACetestgoudeas stmmmrizedon&erion3A i^ nlear from (3.40) that one 

can .design in (3.40) to (ideaily)xxjumeraatihe T d (t) effect on *(t) bynmtply 

- rtntnein g - tjg-i^caai) (3-41) 

^toeorer^d. T d (t) ^xnneeUed,tihet»n«imngomtroltierm ty™> be chosen (ideally) 
asuhedasncal -proporaonat and riemative"*edb^*aw 

Up = .k 1 «-k 2 0 (M^) >0 ' ’ 

to achieve Recondition that * (,) - 0, *t ) - O-pramptiy.-from any initial conditions. In 

-particular, if k 1? k 2 are chosen as_ 


k l = J cg “ 2 n ; k 2 “ 2 J cg ^ “n 


(3.42) 


-the ^corresponding closed-loop equation of-motion (340) becomes (ideally) Re classical 

clam p e d 2nd -order linear system 

# + (2 C u, )* + (» 2 u) 4 “ 0 (id* 521 ) (3A3> 

so that ir. (3.42) Re designer can selectthe “damptagfactor" C > 0 and "tindamped natural 
t req uenc^' o„ > 0 to achieve the desired qualitative and quantitative behavior of *(t) as 

0 (t)-* 0 in (3.43). 
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to summary, the (idealized) control u = T c for the platform is given by 
U = T c = Up - U d 

= -kjf-k^-ldCt) ( idcal ) 

In a-renlistic practical application, the term T„(t) in (3.44) would be replaced by the real- 
ised mcu T d (t) as obtained from ( 338 ) and the observer (3.32). Also, if the platfonn 
p(t) happened not to beavailableas atlireet<semor) measurement, one would 

^replace « in (3.44)byfheobserTer-producedaumate « -* 2 in (332). In this way, the 

practical impiemenumon oftheplatformcontroller (3.44) would take die form 


^ A 

u - r c •-k l 4 >-k 2 * -?d 


t d = in (3.32) 

A 

0 m *2 in (332) 


(3.45) 


The -estimate * = J, produced by (332) is not used in (3.45) since, presumably, *(t) is 
directly measurable. 

The control expression (law) (3.45) together with the composite state observer (3.32), 
(337), constitutes the complete disturbance-adaptive controller design for the platfonn 
^oil^ Tc as shown inHgure 3.6. This controller will automatically adapt-to and quickly 
cancel-oiu any platfonn disturbance actions T a (t) that can berepresented, at least over shon 
nnervais ofume, by me put^mnc-s^e waveform- tnode, (3.25). This include, disturbances 
that are: "stepwise-constant," uncertain combinations of "constants + ramps + accelerations." 
and general, uncertain, meandering-type functions, such as shown in Figure 3.5. The latter 
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Figure 3.6 Proposed Disturbance-Adaptive Platform 
Controller Arrangement. 
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category includes slowly varying 
frequencies, time-constants, etc 


periodic and exponential- type disturbances with unknown 




rvmtynller Using a 

3.7. frT |nnn a nc e Te « W the uwnrnnm^n^y — 

Disturb ” Simulation Mpdgl 

“The ultimate simulation test of -the -proposed -platform eootroUer (3.45) , (332) , 
( 3 J 7 )aatnists of implemendng theequaoons for that eonmtiler on adulation of the 
, nm r . of motion of themttire 3-hnk conceptmodeUhown inFigure 11, 

andthenwatercismg that closed.loopmmnlation by condoning themnd^^ T l( t) and 
T^do-perform back-and-fordislewingmotions toxmubte-typical tapenment-monon" 


ulisUirta ances. Linder s 


i theiace of alle xperim entTnonons. 


zero, *(t)-o, and consistently nemuin atornearze rom 

i tnrnues. etc TheTesults of such a "full-up" test will 

gravity-gradient torques, solar-pressure torques. 


be described in Chapter 5. 

b, this section, we will present the results of a somewhat lower-fidelity simulation test 
of thetphtifonn controller, in which the plmfbrm is correeti, modeled by (3224b) bu, where 
the actual .disturbances T„(t) due to end-link motions, etc, aresymheticutiyjenem^ on die 
computer by a ”function-generation" sub-routme that produces artificial T d («) disturbance 
functions. This procedure avoids die (difficult) derivation and -programming of the 
cmmmmriy compUca^ erne, equations of motion of the 3-link assembly shown in Figure 2.1. 
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As previously stated, the derivation and simulation of those exact equations of motion will 
be addressed in Chapter 4 . 

To demonstrate the validity of the preceding real-time disturbance 
identification/cancellation technique, the mathematical model (3.24b) with the somewhat 
arbitraly . value J cg = 10 was simulated on a digital computer, mang a digital simulation 
program .called Dymisim * The " disturbance -torque" T„(t) in (3.24) was created by 

combntmgvanom standard mathematical time-fimctionslsteps.'Tampsiainusoids.delays, etc.) 

ri-iu.Ku. the p^nsim program. The^tisturbance^adaptive control torque T c (t) in (3.24) 

A 

wargCT erated in the stmulation by equation (3.45) where thereal-time estima.es *(t) and 


T d (t)wrere created by the real-mne composite state-obsetver (332), (337) using the desired 


observer -eigenvalues 

A.J = x 2 = *3 = *4 = *-5 = ' 3 


(3.46) 


The observer gains { k*} in (332) corresponding to (3.46) were computed from (3.37) to be 


*oi = -15 ; *02 = - 90 

Jk n , = -2700 ; *04 - - 4050 

* 05 = -2430 


(3.47) 


The ideal-model (3.43) of the closed-loop platform dynamics was chosen to have 

t = 0.7 ; u n = 1.0 C 3 - 48 ) 

Some representative simulation results are shown plotted in Figure 3.7, where it can 
be seen that, after a short transient, the estimate T d (t) does indeed accurately match the 
actual real-time behavior of T d (t). In a realistic application, one would activate the 
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disturbance observer a short rmre before activating the control u d to allow time for the 
cstinaa f d (t) ,0 accurately match T d (t), and thereby avoid the undesirable effects of the 

(sometimes* 1 large) transient start-up errors in T „(.)• Moreover, the platform controller 
Tc(t) does indeed regulate d(t) to the desired condition {*0 - 0, *(t) - 0> in the face of 
JdaKonditions *0) and unceroindismrbances T d (t). These resuits serve to validate the 
correct functioning of the.algorithms compnsmg thedisturbance^bserver (332) and the 
eonmtiler (3.45). One-shortcoming ui^rremhe^^nenued, end-lmk "dismrbances" 
T„(t), as employed here, is that such disturbances donor-embody the inevitable rarcooru of, 
^,-ti.e T.-controller to the contiol actions of the Tycontroller, and vice versa. Hose 
controller-reaction components of T d (t)are amnescapable (and potentially de-stabilizmg) 
czeaiity ofany real MPMSP dynanncbehavmrnndaaiS -be accurately incorporated into any 
-a— that purports to demonstrate derail MPMSP tiynarmc behavior, including 
stability, in a realistic operating scenario. This concern will be addressed in Chapter 5. 
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for Plant (3.24b) Using a Platform Controller 
(3.45) (3.32)43.37) and Synthetically Generated 
Disturbance T d (t). 
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Chapter 4 

AN EXACT MATHEMATICAL MODEL OF 
THE GENERIC MPMSP IN PLANAR-MOTION 




ic Systems 


41 tv,, rmse Of in Mortrlinf IvhW-Bofe. 

He derivation of the exact equations) of motion for an interconnected set of rigid- 
bodies (hereafter referred to as a multi-bod? dynamic system) would seem, at first glance, 
to bo a straight forward application of the classical Newtonian, Lagrangian, Hamiltonian, etc. 
priociples of dynamics as presenting in literally hundreds of textbooks, and conwnringly 
taught in university classrooms throughout the world over the past cennuy. However, in 
spito of the intellectual profoundness of those classical principles of dvr, am.es, and an 
abundance of (deceptively simple) illustrative examples worked out in textbooks and 
classroom lectures, it turns out that the methods of Newton, Ugrange, Hamilton, etc. are 
inherently inadequate for derivmg the equations of motion for all but the simplest cases of 


multi-body systems. 

This "glass ceiling” feature of the classical methods of dynamics has its origin in the 
"curse of dimensionality" associated with the development of analytical, symbolic solutions 
to certain sets of simultaneous equations that naturally arise as a necessary intermediate step 
in applying those classical methods to a high-order multi-body system. For instance, in 
applying the Newtonian method and "free-body diagrams” to a multi-body system, one must 
firs, solve analytically for the equations that define five reaction forces and moments that 
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occur at the points of interconnection among the set of interconnected bodies-for arbitrary 
kinematic and kmenc condrnons that may occur dunng general motions of the multi-body 
This step is relatively straightforward for, say, two rigid bodies pin-jointed together 
(such as the icubU-pmUum crumple presented in many tests). However, as one considers 
an increasing number of such rigid bodies linked together by pin-joints, the step of 
analytically computing the reaction forces and moments at each pin-joint rapidly becomes 
mathematically intractable. Similar -analytical obstacles are encountered in applying the 
n^.hortv of Lagrange, Hamilton, etc. to multi-body systems of higher order. 

This inherent limitation of the classical methods of dynamics for deriving equations 
of motion for multi-body systems has only recently begun to be recognized by industry 
-practitioners, educators, and (a few) textbook writers. 

42 g«ne , t Metho d f"T M ndeKny Multi-Body Systems 

Further progress in the analysis and control of multi-body systems is inextricably 
linked to progress in overcoming the aforementioned fundamental limitation of the classical 
of dynamics. Fortunately, a new method for developing dpiamic equations of 
which effectively overcomes the aforementioned limitations of classical methods, has 
been discovered by Prof. Thomas Kane of Stanford University. This method, hereafter 
-referred to a Kane's Method, was, in fact, developed and first published in the late 1960’s 
[5], but has become widely recognized as the fundamental contribution that it really is. only 

in the last decade, [6] - [7]. 
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The basic theory and methodology for Kane’s method of dynamic modeling is 
developed, and illustrated by numerous examples, in a recent text [8]. The reader is reterrec 
to that text for further technical details. The essential feature of Kane’s method, from the 
practitioner’s point-of-view, is that regardless of the number of bodies in a multi-body 
system, the exact equations of motion can be developed by a well-defined, tractable, 
systematic procedure involving only the simplest concepts from an introductory course in 3- 

dimensional dynamics. 


43 


The Autoi ™ Computer i 




to 


AianmWKl-Mnririina of Multi-Body Systems 


lima g,ne’« -Method 

The striking simplicity of Kane’s methodology for deriving the exact equations of 
motion for a complex, multi-body system has inspired David Levinson and his associates to 
develop a fully automated digital computer program that automatically executes Kane's 


methodology, and prints out the final equations of motion, for an "arbitrarily" given, complex, 
multi-body system with complex intercotmecrions . This program, called Autolev'is now 
commercially available 1 and was used in this study to derive, in minutes, the horribly 

exam equations of (planar) motion for the generic J-link model of an MPMSP, 

as shown in Figure 2.1. An attractive feature of the Autolev program is that it will, at the 
user’s req uest, automatically convert the final equations of motion into Fortran code for 


1 Online D ynamics, Inc., 1605 Honfleur Dr. Sunnyvale, CA 94087; (408>736-9566 
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subsequent automatic input into the user's existing simulation program, such as Mawx-X. etc. 
in tins way, A«o* allows the user to go from the initial manually input "descnpuon" of the 
multi-body configuration to be modeled, to a working "simulation” of the multi-body system 
o„ a digital computer, in minutes, with no intervening printouts, recopymg, paperwork, 
coding or translating. This complete elimination of virtually all human chores in the 
ram, and computer simulation of complex multi-body ^sterns -represents a major 
comribution to the indusuial community, but dearly places thong -requirements on the 
qualitative correctness and quanthative acotracy of the user’s initial input "desorption" of 
the multi-body configuration to be studied. Indeed, using Aulotm, one can go from the 
motion of the multi-body system to computer plots of the system dynamic resp onse 

without ever seeing the system’s equations of motion! 


4.4 Print-O u t ^ ,h " Fiact EnharionS rif MWiPll fOT til? frffiCT* MFMgP I B 

Plmmr Motion 

The generi c MPMSP 3-link configuration shown in Figures 2.1 and 3.4 was manually 
inpm into tocAutolev program by describing, symbolically, the geometry {*, 8„ Bj, x, y} 
of the overall imk-arrangement, the locations U 0 „ *,} of the centers of gravrty of the 
respective links, the inertia and mass values (J„ M,), the experiment control torques (T,) at 
each pin-joint, and the platform control and external disturbance torques fT e T e ). Using 
tins symbolic description of the multi-body system, the Arnold program executed Kane s 
Method to arrive at the exam equations of motion for the planar-motion case. Those 
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are printed-out on the left side in Autolev). 
Z 21 Ip "*28 ®1 ~ Z 29 ®2 +Z 30 

c 

+Z 31 

n 

“ z 32 " T c 

~ z 28 

0 ~ z 33 

®1 

+ 0 


+z 34 

c 

" z 35 

n 

= ~ z 36~T\ 

~ z 29 

<p +0 


~ z 31 

02 

_z 38 

l 

+ z 39 

n 

1 

9 

1 

II 

z 30 

0 +z 34 

®1 

" z 38 

»2 

” Z 41 

c 

+0 


• z 42 

Z 31 

0 ~ z 35 

0i 

+z 39 


40 


~ z 41 

n 

= z 43 


equations of motion consist of a set of five, 2 nd order, inertia-coupled ordinary differential 
equations which Autolev prmts-out in ti-e form (all the terms shown on the ngh. s.de of (4,11 


(4.16) 

(4,1c) 

(4, Id) 

(4.1c) 

where { and „ denote, respectively, the absolute displacement of the c.g. of the platform m 
dm direction of the platform longitudinal axis L and in the direction N which is normal to 
L (see Figure 3.4). The z,, symbols in (4.1) represent (typktally long, complicated, non- 

linear) functions of {*,8,, 6* M 2 , Jo, J l' J* ‘on *02- £ i- £ 2>- p3racular ’ 

term zrt in ( 4 -la) « «b» augmented inertia function as cited m (3.24b) 

V * (4 - 2) 

•nte actual, raw, hard-copy pnn.-outs of (4.1) as generated autolev, for which the defimttons 
of ^ ta (4.2), and the other z,, in (4.1) can be inferred, are reproduced in Figure 4.1 where 
ul=*; u2 = 8 1 ; u3 —8,; u4 = C ; u5 = ri- Additional Autolev print-out data relevant to 

the model (4.1) is reproduced in Appendix A of this report. 


UAH / ECE Dept / Dr. C. D. Johnson 


Chapter 4, Final Report 



(145) R 


I27*U 1 ' -Z2B*U2 ' -Z29*U3 ' +Z 


= 1 : 


rU4 ' +Z3 1*1)5 ' -Z52-KW7 = 




(146) R = 2: -Z2B*U1 -Z33*U2 '+Z34*U4 -Z35*U5 


■+Z36-t^) = 0 


-> (147) R = 3: 


■ 

— Z29*-U1 ' -Z37*U3 ' -Z38*U4 ’ +Z39*U5 ' +Z40-^W2) = 


-> < 148) R - 4: Z30*U1 '+Z34*U2 Z3B*U3 '-Z41*U4 Z42 - 0 


- — >.££149) R -75* Z31*U1 ‘— Z35*U2 ‘*~Z39»U3 '-Z4HHJ5 Z43 = 0 

-> (101) R ■ 1: ( (-(-C03(THETA2>*L02-L2>*(-C0S(THETA2>*L02-L2)-L 

02*L02*S IN (THETA2 ) *SIN ( THETA2 ) ) *M2+ ( - ( COS ( THET A 1 ) *L0 1 +L 1 ) 

* (COS CTHETA1 )*L01+L1 > -L01*L01*SIN (THETA1 >-*SIN ( THETA 1 ) ) *M1 

- J O- J 1 - J2 > ( - < CDS ( THETA 1 ) *L0 1 +L 1 ) *L 1 *M 1 - J 1 ) *(1)2,7 + ( ( -CD 

g (THETA2) *L02— L2) *-L2*M2~ J 2 ) { HJ3 ^X ( < (— CDS (THETA2) *L02— L2) *S 

IN (THETA2) +COS (THETA2) *L02*SIN <THETA2) >-*M2*- ( (COS ( THETA 1 ) * 

L01+L1 HM3IN (THETA 1 ) -COS (THETA1 >*L01-»SIN (THETA 1 ) ) *M1 )(*U4^ 

< ( - < -COS (THETA2 > *L02-L2) *COS (THETA2) +L02*SIN (THETA2 ) *S I N ( 

THETA2>HHi2-M- (COS (THETA1 ) *L01-*-Ll > *COS (THETA1 ) — LO 1*SIN (TH 

ETA13-»SINtTHETAl) >*H11 >^U5^)-< < <4U1-HJ2>*L01*SIN (THETA 1 )+COS 

(THETA!** U1 -LOl-oSIN (THETA1*-*U2*«IN (THETA 1-><*U5 ) *U 1 + ( COS ( TH 

ETA14«H<44SIf4 (THETA 1 >*U5>*U2-_COStTHETAl HHJ2*U4-SIN ( THETA 1 ) 

-»U2*U5>-* (COS (THETA 1 ) *L01+L1 )*■ ( ( — ( COS ( THET A 1 ) ♦LOl+Ll )*(U1 + 

U2)+C0B (THETA 1 >*L01*U2-C0S (THETA1 )-*U5— L.T-*li2*-S IN (THETA 1 ) *U 

4>-*Ul— 12*9I32«U2> *L01*SIN (THETA 1->4«*M1- (- < (- (-COS (THETA2) *L0 

2-i_2)4»4ti£-H33) -COS ( THET A2 ) *L02*U3-C0S (THETA2H»U5+L2*U3+SIN 

( jh£JA2)*U4>'*U1+L2*U3*U3) *L02*SIN (THETA2) *+■ ( (— (U1+U3) *L02* 

SIN (THETA2 ) +COS (THETA2 ) *U4+L02*SIN (THETA2 ) *U3+S I N ( THET A2 ) 

*U5 ) *U l + ( COS ( THETA2 ) *U4+S I N (THET A2 > *U5 ) *U3-C0S ( THET A2 ) -*U3 

*U4-SIN(THETA2)*U3*U5)*<-C0S(THETA2)*L02— L2) >*M2+W = 0 
Figure. 4.1 Actual Print-Out of Exact Equations of (Planar) 

Morion for 3-Link Generic MPMSP Model Fig. 

2.1, as Automancaliv Derived by Autoin # 

Program. £ 



> ( 102 ) 


> (103) 


R = 2: ( — (COS ( THETA 1 ) *L01+L1 ) *L1-*M1— J 1 ) <-J 1 — LI *L 1 * 

Ml)^uJJ)-Ll*m-*SIN(THETAl)-»^rj)-COS(THETAl)*Ll*MHi^53-< < (U1 
+U2 ) *L0 1*SI N ( THETA 1 ) +COS ( THETA 1 ) *U4-LO 1*S I N (THETA 1 ) *U2+S I 
N ( THETA 1 ) *U5) *U1+ (COS ( THETA 1 MMJ4+SIN (THETA 1 ) *U5> *U2-C0S (T 
HETA1 ) *U2*U4-SIN (THETA1 ) *U2*U5) *L1*M1+W1 = 0 


R = 3: ( <-COS(THETA2)*L02-L2)*L2*M2-J2)^uIJm-J2-L2*L2* 

M2 ) ^U?)-L2*M2*S I N ( THETA2 ) {KW*)+C0S ( THETA2 ) *L2*M2^uFv+ ( ( - ( U 
1 +U3 ) *L02*S I N (THETA2) +C0S (THETA2)*U4+L02*SIN (THETA2) *U3+S 
IN CTHETA2) *U5) *U1+ (COS (THETA2>*U4+SIN (THETA2) *U5> *U3-C0S ( 
THEIA2J *U3*U4— S I N ( THET A2 ) *U3*II5 ) *L2*M2+W2 = 0 


Figure 4.1 Actual Print-Out of Exact Equations of (Planar) 
Motion for 3-Link Generic MPMSP Model Fig. 
2.1, as Automatically Derived by Autoiev m 
Program. 
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( 1 04 ) R 


4: 


> < 105 ) 


,• U-C < THET A2 ) *L02-L2 > *S I N ( THE" ) +C0S ( THETA2 > * 

L02*S I N (THETA2 ) > *M2+ < ( COS < THETA 1 ) *L0 1 +L 1 > *SI N ( THET A1 > -COS 
(TI_j£ 7A1 ) *i_01*SIN ( THETA 1 ) )"*M1 ) & L 1 1 *S I N ( THET A 1 ) *U2J-L 

2*M2*S I N < THET A2 ) *U3J/ < " M0 “ M 1 ~ M2 > * U4 ^~ ( ' ' " < _CDS ( THETA2 } * L ‘-' 
2-L2 ) * ( U 1 +U3 > -COS < THETA2 ) *L02*U3-C0S ( THETA2 ) *U5+L2*U3+S I N 
(THETA2 > *U4 > *U 1 +L2*U3*U3 ) *COS < THETA2 >-(<-( U 1 +U3 > *L02*S I N ( 
THETA2) +COS (THETA2 ) *U4+L02*SIN (THETA2) *U3+SIN (THETA2) *U5) 
*U 1 + < COS < THET A2 ) *U4+SIN ( THETA2 > *U5 ) *U3-C0S < THET A2 ) *U3*U4- 
SIN <THETA2)*U3*U5) *SIN (THETA2) >*M2— <— < ( (U1+U2) *L01*SIN (TH 
ETA1 ) 4-COS (THETA 1 ) *U4-L01-*SIN(THETA1 >*U2+SIN (THETA 1 > *U5 ) *U 
1 + ( COS (THETA 1 ) *U4+SIN (THETA«*U5**L12-C0S (THETA 1 ) *U2*U4-S I 

N(THETAl>4HJ2*U5>**SIN<THS»l->-M<-«C0S(THETAl)*L01+Ll)*(Ul + 

U2) +COS < THETA 1 >*L01*U2-:CDS (THETA 1 >*U5-L1*U2+SIN(THETA1 ) *U 

4)*Ul-Ll*U2*U2)*C0S(THETAl)4HMil-H10*Ul*U5 = 0 


R , 5, < < - < -COS ( THETA2 ) *J_02-J_2 ) *COS ( THETA2J-hL02*S I N < THE 

TA2) *SIN(THETA2) >*M2+ (-TCOSTTHETAl >*L01+L1 >*COS (THETA1 ) -L 
01*SIN (THETA 1 ) *SIN < THETA 1 ) >-*Ml > {uT^COS (THETA1 ) *Ll*m*LJ2' 
+COS (THETA2) *L2*M2*U3Vb (—MO— Ml— M2 > *05^ * L ( < < <U1+U2> *L01*SIN 
(THETA1 )+COS (THETA 1 > *U4—L01*S IN (THETA 1 ) *U2+S IN (THETA 1 ) *U5 
) *U 1 + < COS ( THETA 1 ) *U4+S IN (THETA 1 ) *U5> *U2-C0S (THETA1 ) *U2*U4 
-S I N ( THETA 1 ) *U2*U5 ) *COS (THETA 1 ) + <(-< COS (THET A 1 > *L0 1 +L 1 > * < 
LI 1 +U2 ) +CQS (THETA 1 ) *L01*U2-C0S (THETA 1 )*U5-L1*U2+SIN (THETA1 
) *U4) *U1— LI *U2*U2> *SIN ( THETA 1 ) ) *M1— < < (— (— COS (THETA2) *L02- 
L2 ) * < U 1 -HJ3 ) -COS ( THETA2 ) *L02*U3-C0S ( THETA2 ) *U5+L2*U3+S I N ( T 
HET A2 ) *U4 ) *U 1 +!_2*U3*U3 ) *SI N ( THETA2 ) + ((-( U 1 +U3 ) *L02*S I N ( TH 
ETA2) +COS (THETA2) *U4-H_02*SIN (THETA2) *U3+SIN (THETA2) *U5 ) *U 
1 + ( COS ( THET A2 ) *U4+S I N ( THET A2 ) *U5 ) *U3-C0S ( THET A2 ) *U3*U4-S I 


( THET A 2 ) *U 3 *U 5 ) *C 0 S ( THETA 2 ) ) *M 2 -MO*U 1 *U 4 = 

. i- -r t 

Figure 4.1 


0 


Actual Pnnt-Out of Exact Equations of (Planar) 
Monon for 3-Link Generic MPMSP ModeL Fig. 
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« VoUHntlnn nf to Atu c ^—^ * Mmion for the »** "B B 

figneric Model 

As indicated in Section 4.3, the Autolev program will, at the user s request. 

ideally convert the mode. (4.1) into Foman code tot can ton be immediately input 

into an existing "dynamic-system simulation program," such as Mamx-X, etc. This was done 
for to present study (using Mamx-X installed on a UAH 486/33 PC). A listing of that 
Auto/ev-generated Fortran code is shown in Appendix A. The resulting Mamx-X simulation 
of to 3-link MPMSP model was "exercised" for some representative end-link, back-and-forth 
slewing motions (controlled via T,, T 2 ) with to platform controller T c and external torques 
T e set to zero. The results obtained, using to parameter-values listed in Table 5.1, are 
^ a, Figures 42, 4.3, and their seeming agreement with what one would intuitively 
^rved to establish our confidence in to validity of both to mathematical model 
(4.1) and to Mamx-X simulation implementation, via to Fortran code generated by 

Autolev. 

An innovative and useful feature of to /tatoiev-generated Fortran simulation code 
is tot it automatically computes and prints out to time-variation of to tgjal linear 

and laal angular momentum of to multi-body system being simulated. This 

feature allows to user to easily verify tot to simulated multi-body system does, indeed, 
obey known momcnatm<onservaaon conditions, when they apply. In our validation runs 
described above, where T c (t) - T e (t) - 0, the torques T,(t), T 2 (t) controlling the end-link 
motions were "internal torques" with respect to the system and, therefore, should not have 
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altered the system's total angular momentum. That conservation of total angular momentum 
of the overall system was indeed evidenced in the simulation print-out of instantaneous total 
angular momentum values vs. tune r as shown in the typical result in Table 4.1 and Figure 

4.4. 

In the next chapter, the "exact" Autolev-bsscd computer simulation of the 3-link 
generic MPMSP model described in this section, is used as a test-bed to verify the 
effectiveness of the previously designed DAC platform controller (3.45), (3-32), (3.37) in 
keeping the platform quiet in the face of a general class of controlled end-link motions 0j(t), 
02(t) and some representative external disturbance torques T e (t). 
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10 15 iU 25 30 35 ^ 


Figure 4 2 Representative Plots from Simulation Validation 
Tests of the Model (4.1) with T c (t) = T e (t) * 0; 
T (t) = sinusoidal at freq. G>j, i = 1,2 (Case: = 

0.33; o>o = 0.5.) 
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Ficure 4.3 Representative Plots from Simulation Validation 
Tests of the Model (4.1) with T c (t) * T c (t) ■ 0; 
T (t) = sinusoidal at freq. Wj, i = 1,2 (Case: = 

0.75; 0), = 1.0.) 
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SUBROUTINE ANBMOM(T.U ‘1 . HNZ ; HN3 . HN 

IMPLICIT DOUBLE PRECISION <A I' 

DIMENSION UU7> 

y ' ( I 5 ’ j-> MO Ml . M2 . p I . DEBTOR AD . RADTODEG , LO 1 . L02 . L: 
COMMON /CPAR/Ju. J* „i*.nu.ni,iu^ri _ -4 , reuTSB-? ami 


COMMON/CZEES/Z ( 4 b> 

, L , k L1 !So'kr2:krI:kro:cenIer: :^.: o« EGft i .catena. ««.««*= 


PHI = 

U ( 6 > 

THETA 1 

= 

THETA2 

= U C B 

phiabsint = u > 9 

PHI I NT 

■ 1 = U ( 1 0 ) 

THE 1 1 NT = U ( 1 1 > 

THE2INT = U ( 12) 

XOl = 

U ( 13) 

X02 = 

U ( 1 4 ) 

Z01 = 

U(15) 

Z02 = 

U(16) 

Z03 = 

U(17) 


51 = DSIN (THETA 1 ) 
Cl = DCOS ( THETA 1 ) 

5 2 = DSIN (THETA 2 ) 
C 2 = DCOS <THETA 2 ) 


ZH 1 = U ( 4 ) *Z ( 45 ) -U ( 5 ) *Z ( 44 ) 
ZH 2 = C 1 *L 1 +L 01 -Z ( 44 ) 


ZH 3 = 
ZH 4 = 
ZH 5 = 
ZH 6 = 
ZH 7 = 
ZHB = 
ZH 9 = 
ZHIO 
ZH 1 1 
HNI = 
HN 2 
HN 3 
HN 


L 1 *S 1 -Z ( 45 ) 
Cl*Z(ll)“Si*Z( 12 ) 

Cl*z (12)+S1*Z <11 ) 

ZH 2 *ZH 5 -ZH 3 *ZH 4 
-C 2 *L 2 -L 02 ~Z ( 44 ) 

-L2*S2-Z (45) 

C2*Z (20) — S2*Z (21 > 

= C2*Z (21)+S2*Z (20) 

= ZH10*ZH7-ZHB*ZH9 

= o • 0 

- o . 0 _ ^ 

= JC»*U ( 1 >+J 1*2 ( 13)+J2*Z (21 
= DSQRT (HNI *HN 1 * HN2*HN2 


> +MO-*ZHl-*-Ml*ZH6+M2*ZHl 
+ HN 3 *HN 3 ) 


RETURN 

END 


Table 4.1 

Amo lev Set-Up for Plotting Instantaneous Total Angular Momentum Values vs. Tune 
for a Typical Simulation Validation Run: T c * T e * 0, M -2 
[Table Continued Next 3 Pages] 
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' I LE ; Df 


COUTPU" 


'i PROGRAM DAw.rOP 


QIMULATION RUN WITH Tc-O. END LINK COMMAND PRES . =0 . — • . O^rao/se: 

rllmtm. mm** leutmesser to tan 


SIMULATION RESULTS (V&htjditv* RtM&l) 


\ _ 


0 . OOOOOE+OO 

5. OOOOOE— 0 1 
1 . OOOOOE+OO 
1 . 50000E+00 
2. OOOOOE+OO 
2.50000E+00 
3. OOOOOE+OO 
3. 50000E+00 
4 . OOOOOE+OO 
4 . 50000E+00 
5. OOOOOE+OO 
3. 50000E+00 

6. OOOOOE+OO 
6. 50000E+00 
7 . OOOOOE+OO 
7. 50000E+00 
B. OOOOOE+OO 
S. 50000E+00 
9. OOOOOE+OO 
- . 30000E+00 
1 . OOOOOE+O 1 
1 . 05000E+0 1 
1. 1 OOOOE+O i 
1. 15000E+01 
i . 20000E+0 1 
1 . 25000E+0 1 
i - 30000E+0 1 
: . 35000E+0 1 
1 . 40000E+0 j 
1 . 45000E+0 1 
1 - 50000E+0 1 
1 . 55000E+0 1 
I . 60000E+0 1 
1 . 65000E+0 1 
1 . 70000E+0 1 
1 . 75000E+0 1 
1 . BOOOOE+O 1 
1 . B5000E+01 
i . 90000E+0 1 
: . 95000E+0 1 
C. OOOOOE+O 1 
” B 05000E+C - 
1. 10000E+C:, 
22 . i 5 Ou ij E + ! ’J 1 
I . 2 OOOOE+O ] 


HN: 


, 250 OOF- 
. 7:000' 


n+m + E 


HN2 


HN7 


Ffrijjitr ^ome* Jw* 


(N+M+5 




0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
Ci . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OC 
0 . OOOOOE+OO 
0 . OOOOOE+OC 
0 . OOOOOE+OC: 
0 . OOOOOE+OC: 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
Ci . OOOOOE+O 0 
0 . OOOOOE+OC 
Ci . OOOOOE+OO 
0 . OOOOOE+O I 
0 . OOOOOE+O - 
0 . OOOOOE+O - 
0. OOOOOE+O . 
0 . OOOOOE+OC 


O . OOOOOE+OO 
0. OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
o . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
Ci . OOOOOE+OO 
0 . OOOOOE+OO 
Ci . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O - OOOOOE+OO 
Ci . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
Ci . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
Ci. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
j . OOOOOE+OO 
0 . OOOOOE+OO 
. OOOOOE+OO 


Ci . OOOOOE- 


-u( i 


Table 4.1 

Instantaneous Total Angular Momentum 

- « r 1 • 1 Ti _ . I 


-5. 65480E-1 1 
-5. 13900E-1 1 
—5. 0S3B6E-1 1 
—5. 16B65E— 1 1 
-5. 15269E-1 1 
-5. 13147E-1 1 
-5. 13134E-1 1 
—5. 1422BE— 1 1 
-5. 15336E— 1 1 
-5. 15B3BE— 1 1 
-5. 15573E— 1 1 
-5. 14B96E-1 1 
-5. 14017E— 1 1 
-5. 136B9E— 1 1 
-5. 13518E-1 1 
-5. 14125E-1 1 
-5. 14B27E-1 1 
-5. 1563BE-11 
-5. 15906E- 1 1 
-5. 15725E— 1 1 
-5. 15130E— 11 
-5. 1 4497E- 1 1 
-5. 14316E-1 1 
-5. 14674E-11 
—5. 15362E-11 
-5. 1577BE- 1 1 
-5. lolooE-l 1 
-5. 15B43E-1 1 
-5. 1495BE— 1 1 
-5. 14400E-1 1 
-5. 14303E— 1 1 
-5. 14924E-11 
-5. 15BB9E-1 1 
—5. 16742E— 1 1 
-5. 16924E-11 
—5. 16360E-11 
-5. 1506 IE- 1 1 
-5. 14074E— 1 1 
-5. 13447E-1 1 
—3. 13661E-1 1 
-5. 1 4390E- 1 1 


( NJ*M*s 


iJ ^ ^ ^ 

-5. 1656BE-1 1 
1 F92" T=r “ 1 2 


1 . 400C 


( -| ( *,for a Typical Simulation Validation Run: 


5000' _, r - 


. . 'J* juv. 


i.kjv + 

■ * v i * » — 


Values vs. Time 
* T e * 0; Tj ,T 2 

r “ i 1 1 


. OOOOOE+OO 

. 654B0E-1 1 
. 13900E-1 1 
. 08386E- 1 1 
. 16B65E-1 1 
. 15269E-1 1 
. 13147E-1 1 
. 13134E-1 1 
. 1 422BE- 1 1 
i. 15336E- 1 1 

I. 15B3BE-1 1 
i. 15573E-1 1 
i. 1 4896E— 1 1 

14017E-U 
136B9E-1 1 
1351BE-1 1 
1 4125E- 1 1 
*. 14827E-1 1 

J. 15638E-1 1 
i. 15906E-1 1 
5. 15725E-U 
J. 15130E-1 1 
5. 14497E-1 1 

14316E-U 
i. 14674E-11 
i. 15362E-1 1 
S. 1577EE-1 : 
5. I 6 I 00 E— 1 1 
5. 1 5B43E- 1 : 
5. 14958E-1 1 
5. 14400E-1 1 
5 . 1 4303E- 1 1 
5. 14924E-1 1 
3. 15889E-1 1 
5. 16742E-11 
5. 1 6924E- 1 1 
1 6360E— 1 1 
15061E-1 1 
14074E-1 1 
13447E-1 1 
13661E-1 : 
14390E-1 1 

1. w' ^ .j - — — - — 

1 6566E- 1 1 

^ ^ C ^ " 

1 6607E- 1 
1 5~9 iE _ - 
14B99Z- : : 
3 4565E- 1 
i ^9049 






ORIGINAL PAGE IS 
_ i*aao ni 1 ALlT\ 



CM r.'i -r- 


FILE: 


PROGRAr 


SIMULATION RUN WITH i c*U . ENL +J±i_ 
INITIAL ANGULAR VELOCITY OR CENTEr. 
.-v, . OTHER INITIAL VELOCITIES EQUAL 


COMMAND FREQ . =0 . 
L I Ni- rad.' sec 


iT I ON F; 


E3ULTS ( Valid alio* Puh rtz) 


, OOOOOE+OC 
, OOOOOE-0 1 
, OOOOOE+O V 
. 50000E+00 
. OOOOOE+OO 
. 50000E+00 
. OOOOOE+OC) 

. 50000E+00 
. 00000E+0O 
. 50000E+00 
. OOOOOE+Ou 
. 50000E+00 
. OOOOOE+OC) 

. 50000E+00 
. OOOOOE+OO 
. 50000E+00 
.OOOOOE+OO 
50000E+00 
1 . OOOOOE+OO 
» . 50000E+00 
. OOOOOE+O 1 
. . 05000E+0 1 
. 1 OOOOE+O 1 
. . 15000E+01 
2O0OOE+C* . 

L . 25000E+0 - 
■ . 30000E+0 1 
L . 35000E+0 1 
i . 40000E+0 1 
1 . 45000E+0 i 
1 . 50000E+0 1 
1 . 55000E+0 1 
1 . 60000E+0 1 
1 . 65000E+0 1 
1 . 7 OOOOE+O 1 
1 . 75000E+0 1 
1 . BOOOOE+O I 
1 . 35000E+0 1 
: . 9 OOOOE+O ■ 
1 . 95000E+0 : 
1 . OOOOOE+O : 
2 . 05000E+0 I 
2. 1 OOOOE+0 - 


HN1 

(N+M+S) 

0 . C>OOOOE+O0 
0 . OOOOOE+OO 
0. OOOOOE+Oo 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OC' 

0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OC' 
0. OOOOOE+Oo 
2 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+Oo 
0 . OOOOOE+OO 
0 . OOOOOE+OC' 
0 . OOOOOE+Oo 
0 . OOOOOE+OC) 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OC' 
0 . OOOOOE+OO 
0 . OOC'C'OE+OO 
OOOOOE+UU 
. OOOOOE+OO 
. OOOOOE+OC 
. OOOOOE+OO 

0 . OOOOOE+Oo 

1. j. OOOOOE+Oo 


HNC 

(N+M+9 • 

O . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OC) 

0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
o . OOOOOE+OO 
0 . OOOOOE+OC' 

O . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 • OOOOOE+OO 
o . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . 00000E+OU 
2 m 00000E+OO 
0 . OOOOOE+OO 
0 . OOOOOE+Oo 
O . OOOOOE+OO 
0 . OOOOOE+OC) 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . 0 0 O 0 0 E+O 
O - OOOOOE+Oo 
j . 00000 E"*” O' . 
<;* ; m O 0 0 0 0 E V * 
i'. „ OOOOOE + O'. 
: j . OOOOOE+*00 
j n OOOOOE+ O’. 


HN3 




2. 2B99BE+0 i 
2. 2899BE+0 1 
2. 2B99BE+01 
2. 2899BE+01 
2.2B99BE+01 
2. 28998E+01 
2.2B99BE+01 
2 . 28998E+0 1 
2. 2899BE+0 1 
2 . 28990E+0 1 
2. 28998E+01 
2. 28998E+0 1 
2.2B99BE+01 
2 . 2B998E+0 1 
2.2B99BE+01 
2 . 2899BE+0 1 

2 . 2B998E+0 1 
2 . 2B99BE+0 1 
2 . 2B99BE+0 1 
2. 2899BE+01 
2 . 2B998E+0 1 
2. 28993E+01 
2.2B99BE+01 
2. 2B99BE+0 1 
2. 2899BE+01 
2. 28998E+01 
2. 2B99BE+0 i 
2. 28998E+0 1 
2. 2B99BE+0 1 
2. 2B998E+0 1 
2. 2B99BE+01 
2. 2099BE+O1 
2 . 2B99BE+01 
2 . 2899BE+0 1 
2. 2B99BE+0 1 
2. 2899BE+01 
2. 2899BE+01 
2. 28998E+0: 
2 . 2B99BE+0 1 
2. 2899BE+01 
2. 28998E+01 
2. 2B99BE+01 
2. 2B99BE+01 


Zi Instantaneous Total Angular Momentum Values vs. Time 
‘•’for a Tvpical Simulation Validation Run: T c * T e ■ 0: Tj .T 2 

— - _ -f <• _ • _'tT~ T " T CT " r ‘-' 


(N+M+S 

, 2B99BE+0 5 
. 2899SE+0 1 
, 2B99BE+01 
. 2B99BE+01 
. 2B99BE+0 i 
. 2899BE+0 1 
. 2B99BE+0 1 
. 2B99BE+0 1 
. 2B99SE+0 1 
. 2B998E+0 1 
. 2899BE+0 1 
. 2B99BE+0 1 
. 2899BE+0 1 
. 2S998E+0 1 
. 2B99BE+01 
2B99BE+01 
: . 2B998E+0 1 
2B99BE+01 
2B99BE+0 1 
2899BE+0 1 
>. 2B99BE+01 
I. 2B998E+01 
2B998E+0 1 
2. 2S998E+01 
28998E+0 j 
28998E+C- 

1. 2B99BE+0. 

2. 2B99SE+0 1 
2 . 2B99BE+0 1 
Z. 2B99SE+01 
2. 2B99BE+0 1 
2. 2B998E+01 
2. 2B99BE+01 
2. 2B990E+0 1 

2. 2B99BE+0 I a 
2.2B998E+01 0 %, 

2. 2B99BE+0 .■ 

2 . 2B998E+0 1 Op 

2. 2B99BE+C £ 
2 . 2B990E+O : 

2 . 29^9 BE +0 
2. 2B99SE+0 : 

2. 20993E-K’ 

2 . 2B99BE-K . 

2 - 2B99SE+C . 

2 . 20990E+O 
2. 2B99BE- : 

2 . 29 p 9E=: - ' 

"■sen r: ... 



DAD. r 


, QUTF'L 


P RuG^R AM Unu* i"Ur. 


SIMULATION RUN WITH Tc=,. cNL LINK 
*** INITIAL ANGULAR VtLOLlTV Or CENTER 
ALL OTHER INITIAL VELOCITIES EOUhL 

simulation results (ValMm Ruk#3) 


COMMAND FREQ. = 0 


LINK =0.1 rad/ sec 


<s > 

0 . 00000E+OO 
5 . OOOOOE-Oi 

1 . OOOOOE+OO 
1 . 50000E+00 
2 . OOOOOE+OO 
2.50000E+00 
3. OOOOOE+OO 
3. 50000E+00 
4 . OOOOOE+OO 
4 . 50000E+00 
5. OOOOOE+OO 
5 . 50000E+00 
e. OOOOOE+OO 
6. 50000E+00 
7. OOOOOE+OO 
7.50000E+00 
8. OOOOOE+OO 
8.50000E+00 
9 . OOOOOE+OO 
9 - 50000E+00 
1 . OOOOOE+O 1 
1 . 05000E+0 1 
1 . 1 OOOOE+O 1 
1 . 1 5000E+0 1 
1 . 20000E+0 1 
: . 25000E+0 1 
1 . 30000E+0 i 
1 . 35000E+0 l 
1 . 40000E+0 1 
1 . 45000E+0 1 
1 . 50000E+0 1 
1 . 55000E+0 1 
1 . ©OOOOE+O 1 
1 . E5000E+0 1 
1 . 70000E+0 1 
1 . 75000E+0 1 
1 . BOOOOE+O 1 
1 . 85000E+0 1 

1 . ROOOOE+O I 
• _ 95000E+0 i 
2. OOOOOE+O i 
2. 05000E+0 1 
2- 1 OOOOE+O 1 
2. 15000E+0: 

2. 200'-'-' 


HN j 

( M+M+S • 

0 . 00000E+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
o . OOOOOE+OO 
G . OOOOOE+OO 
OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+O'. > 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0. OOOOOE+OO 
0. OOOOOE+OO 
0 . OOOOOE+OO 
u . OOOOOE+O/ 
0. OOOOOE+O 1 - ■ 
0 . OOOOOE+*. ' 

... . OOOOOE+O ’’ 
i_) . OOOOOE ■ ' 
0 . 00000 Cj -''" ! 


o 


HN2 

( N+M+S • 

O . OOOOOE+OO 
0 . OOOOOE+OO 
o . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 • OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
OOOOOE+OO 
OOOOOE+OO 
OOOOOE+OO 
OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
Q . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
O . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
0 . OOOOOE+OO 
v . OOOOOE+OO 
G . OOOOOE+OO 
t OOOOOE + O'J 
. . . 0 0 O O 0 E + u ; 
j m OOOOOE+Uv 

Table 4.1 


o . 

o . 
0 . 

o , 


HN. 

< N+M+ S 1 

2. 2899BE+0 1 
2. 2B99BE+0 1 
2. 2B99BE+0 1 
2. 28998E+01 
2 . 2B99BE+0 1 
2. 2899BE+01 
2. 2B99BE+01 
2.28998E+01 
2. 2B99BE+01 
2. 2B998E+01 
2. 2B998E+0 1 
2. 2899BE+01 
2. 2899BE+01 
2 . 28998E+0 1 
2. 2899BE+01 
2 . 28998E+0 1 
2 . 2B998E+0 1 
2 . 2B998E+0 1 
2 . 2B99BE+0 1 
2. 2899BE+0 1 
2. 2899BE+0 1 
2 . 28998E+0 1 
2. 2B99BE+0 1 
2. 2B99BE+01 
2. 2B998E+01 
2. 28998E+0 1 
2. 2899BE+01 
2. 2B998E+01 
2.2B99BE+01 
2.2B998E+01 
2. 2899BE+0 1 
2. 2B998E+0 1 
2. 2B998E+01 
2. 2B998E+01 
2 . 2S99BE+0 1 
2. 28998E+01 
2. 2899BE+01 
2- 28998E+0 : 
2. 2S99BE+01 
2 . 2899BE+0 I 
2. 2S99BE+0I 
2. 2B998E+0 1 
2. 2999BE+0 1 
_ . 28 C? 9BE+C * 

j-(-) - 


ToiaL 


Instantaneous Total Angular Momentum Values vs. Time 


Hr 

(N*M+c 

2B99BE+C . 
2B99BE+0 1 
I. 2B99BE+0i 

1. 2B99BE+0 1 
3 2B99BE+0J 
2 . 28998E+0 i 

2 . 2B99SE+0 1 
Z. 2B99BE+01 
Z- 28996E+0 1 
Z. 2B99BE+01 
2. 2B99BE+0 1 
2. 2B99BE+0 1 
2. 2899BE+01 
2. 2B99BE+0 1 
2. 2B998E+0 1 
2. 28998E+0 1 
2. 2B99BE+0 1 
2. 2899BE+0 1 
2. 2B99BE+0 1 
2. 2B99BE+0 1 
2. 2B99BE+0 1 
2. 2899BE+0 1 
2. 2B996E+0 1 
2. 2B99BE+0 ! 
2. 2B99BE+0 . 
2. 28R9BE+C : 
2. 2B990E+O : 
2. 28998E- | -0 1 
2. 2B990E+O 
2. 2B99BE+0 
2. 2B990E+O 
2. 2B99BE+0 
2. 2B990E+O 
2. 2B990E+O 
2. 2B99BE+0 
2. 28998E+0 
2. 2B99BE+0 
2. 28990E+O 
2. 29 qq EE- 

2 . 2B99BE-rO 
2. 2099EE* 1 - 
2. 2B990E+O 
2. 2B99BE--: 
2. 299REE-*- r 
-• 0095 =' 

2.2899BE 


■ '• for a Typical Simulation Validation Run: T c - T e * 0: "A * 0 3* 


TOTAL ANGULAR 



Fieure 4 4 Time-Plots of Variation in Total Angular 

~ ' Momentum of 3-Unk Generic MPMSP Model 

During Validation Tests in Figures 4.2 and 4 . 3 . 
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Chapter 5 

PERFORMANCE EVALUATION OF THE DISTURBANCE-ADAPTIVE 
PLATFORM CONTROLLER USING AN "EXACT SIMULATION OF THE 
3-LINK GENERIC MPMSP MODEL IN PLANAR MOTION 

In this chapter we present the closed-loop simulation results obtained by exercising 
the "exact" dynamic model (4.1) of the 3-link generic MPMSP system using a simulation of 
the proposed disturbance-adaptive platform controller designed in Section 3.6 of Chapter 
3. The results clearly show the effectiveness of the platform controller in identifying and 
adapting to the kind of complex, uncertain, time-varying disturbances that will be common 
on any realistic MPMSP. In addition, the simulation results in this chapter provide vivid 
evidence of the "controller-induced destabilization" phenomena described in Chapter 1; 
namely, that the individually stable, pointing/tracking controllers associated with each on- 
board experiment can, under certain conditions, begin "fighting" with each other, with the 
result that the entire MPMSP then undergoes a chaotic-like motion that can lead to 
instability of the entire MPMSP system. 

5.1 Overview of the Performance Evaluation Test Procedure 

The purpose of the simulation tests described herein is to demonstrate that the 
disturbance-adaptive platform controller (3.32), (3.37), (3.45) controlling the "exact" dynamic 
model (4.1) of the 3-link system of Figure 2.1 does indeed regulate the platform angular 
motion <p(t) to essentially zero, in the face of a general class of experiment pointing/slewins 
motions (end-link motions) 6j(t), 0 2 (t). For this purpose, the two experiment (torque) 
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controllers T^-), T 2 (*) that control 0j(t), 0 2 (t) respectively, were designed as conventional 
Proportioned, Integral, Derivative (PID) controllers, having the form 

t 

T i = k £1 (0,0-6,) * k i2 ei + k i3 J {e ic (r)-6 i (r)}dr (5J) 

i = 1,2 

where the ky , j = 1, 2, 3 are constant controller gains chosen to make each 8j(t) accurately 
track the given time-varying "command" motion 0 ic (t) - - assuming a quiet platform 
0(t) « 0. The commanded scanning motions 0 ic (t) for the two e x p erim ents were assumed 
to have the biased-sinusoid form 

e ic( t ) * e io + e ia sin (“l 1 ) 5 *-1.2 ( 5 * 2 ) 

•where the values of the parameters {0 io , 0^, c*)j > were chosen to simulate generic 
experim ent slewing commands. 

The two e x p erim ents’ controlled, but un -coordinated, slewing motions 0j(t), 0-,(t) 
impart an uncertain, random-like "reaction torque" on the center-link (platform) in Figure 
2.1. We will assume those reaction torques cannot be directly measured in real-time. In 
addition to the reaction-type sources of platform disturbances, a separate and more general 
type of uncertain, imm easurable external disturbance torque T e (t) was considered to act on 
the platform, simulating the combined effects of uncertain gravity gradient torques, solar 
pressure torques from the solar panels, and any other external sources of torques that might 
act on an actual MPMSP. Accordingly, the generic waveform structure of T e (t) was assumed 
to be represented by 
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T e (t) = Cj + G>t + C^r + C 4 sin &> a t + C 5 cos « b t ( 5 . 3 ) 

where w a u b are presumed known characteristic frequencies of T e (t) and the Cj. i = 1. 2 

5, are weighting "constants" that may occasionally jump in value in a once-in-a-while fashion 
as in Figure 3.1. Thus, (5.3) is a spline-function model of T e (t) that can emulate a rich 
variety of uncertain en vironm ental torques that an actual MPMSP might experience on- 
station. 

The effectiveness of the platform controller in regulating 0(t) -»0, and maintaininp 
0(t) » 0 for an extended period of time, was tested by starting with <*>(t 0 ) • 0 and 
commanding 0j(t), ^(t) to track the continually varying 0 ic (t) in (5.2) while the platform was 
-subjected to a given persistent disturbance T e (t) in (5.3). In some runs, T e (t) was set to zero 
for comparison purposes. 

The resulting time-variations of {e^t), S^t), <p(t), T c (t), T e (t)}, obtained from the 
simulation, were then plotted. 

5.2 Parameter Values Used in the Simulation Tests 

As explained in Chapter 1, Section 1.4, the main focus of this research effort was to 
develop and demonstrate a new control concept that could form the technology basis for 
designing high-performance platform controllers for MPMSP-type projects. Thus, the 
numerical parameter-values selected for the simulation exercises were not chosen to 
represent any specific MPMSP, or specific experiments, that may be currently under 
consideration, but rather to represent a size/scale range that seemed reasonable for a generic 
MPMSP system configured in the form of the simplified 3-link model in Figure 2.1. Based 
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on these considerations the parameter-values for the 3-link model in Figures 2.1. 3.4 were 
chosen as shown in Table 5.1 below: (values shown are in non-dimensional units) 


Mo 

H 

mass of platform (center link) 

B 

100.0 

Mi 

H 

mass of right-link (Experiment #A) 


5.0 

m 2 

D 

mass of left-link (Experiment #B) 

B 

7.5 

Jo 

H 

rotational moment of inertia of "platform wjr.txg. 

B 

100.0 

Ji 

H 

" " " " right-link wj.t.cg. 

B 

5.0 

h 

D 

" " " " -left-link wj.Lcg. 

B 

7.5 

hi 

D 

(See Figure 3.4) 

B 

2.0 

*02 

H 

( " ) 1 


2.0 

*1 

B 

( " ) 

B 

1.5 

*2 

2 

B 

( " ) 

B 

2.0 


Table 5.1 Simulation Parameter Values for3-Iink MPMSP Model 
in Figures 2.1, 3.4 (Values are in non-dimensional units) 


The gains kj. for the PID exper im ent controllers (5.1) at each end link were chosen 
to yield closed-loop 0j(t)-dynamics having their 3 closed-loop poles (under the idealized 
assumption that <p(t) * 0) as follows: 

rw v Both experiments have their 3 closed-loop poles set at 

Xj = ^2 ~ ^3 ~ *1 (5.4) 

Case 2: Both experiments have their 3 closed-loop poles set at 

X : = X 2 = x 3 = -2.5 (5.5) 

The 2 nd order ideal-model (3.43) for the closed-loop platform dynamics <p(t) was 


UAH / ECE Dept. / Dr. C. D. Johnson 


4 


Chapter 5, Final Report 



















A Multiple Pointing-Mount Control Strategy for Space Platforms 

NMMMN I 0.0 lit 


chosen to have the parameter values 

i = 0.89 ; w n = 4 - 472 ( 5 - 6 ) 

which correspond to the two closed-loop poles 

= -4.0 ± j 2.0 (5.7) 

The gains koi for the composite plant/disturbance observer (332) were designed to place the 
five poles A. 0 i of the associated estimation error dynamics (333) at the locations: 

^01 = *02 = — = *05 = (5-8) 

The specific sinusoidal scannin g commands (53) for the end-links were chosen as follows: 
£o£ Right-Link 

6 ic (t) = 170 + 30.0 sin (1.45 t) (5.9) 

02 c(t) = 0 + 25 sin (1.60 t) (5.10) 

Finally, the initial-conditions for the angles 0 , 0j, 62 in Figure 2.1 were chosen as 

0 (0) = 30 

6 ^ 0 ) = 200 

e 2 (0) = 0.0 (5.11) 

Using the numerical parameter values in Table 5.1 and in (5.4) - (5.11), the 
Autolev/Matrix-X simulation was exercised for a run-time of 40 - 50 units. Some 
representative results obtained for Case 1 of (5.4) are shown in Figures 5.1 - 5.4, where it 
can be seen that 0 (t) is gracefully regulated to the desired value 0 (t) = 0, and is closely 
maintained there, while the two end-links undergo their continuous back-and-forth scanning 
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motions (5.9), (5.10). In other simulation runs for Case 1 of (5.4), the initial-conditions 
(5.11) were varied over a wide range with results essentially the same as shown in Figures 
5.1 - 5.4. 

Thus it can be concluded that for the Case 1 configuration defined in (5.4) the 
proposed platform controller does indeed achieve and maintain a "quiet" platform 0(t) » 0, 
in the face of the typical equipment scanning motions 0j(t), 0 2 (t) associated with the 
scanning co mman ds (5.9) , (5.10) — provided the two experiment controllers have their 
individual closed-loop poles set at Xj — X 2 = X 3 = - 1 . The reader is cautioned that this 
conclusion is highly dependent on the assumption of a Case 1 configuration (5.4) for the 
experiment controller closed-loop poles. In the not section, it will be demonstrated that a 
seemingly innocuous tightening of the experiments’ individual closed-loop responses (i.e. 
placing the experiment closed-loop poles deeper into the left-half plane as in Case 2, 
Equation (5.5) will result in the onset of instability for the whole MPMSP system! 

5.3 Simulation Results for the Case 2 Configuration f5.5) 

The simulation runs associated with Figures 5.2, 5.2 were repeated with exactly the 
same parameter values, with the exception that the individual experiment’s closed-loop poles 
were moved deeper into the left-half plane in accordance with Case 2 defined in (5.5). The 
corresponding plots of <fi(t), 0j(t), 0 2 (t), etc. are shown in Figures 5.5 and 5.6, where it can 
be seen that the platform tilt tf>(t) in this case does not approach zero, but rather oscillates 
with increasing amplitude. This overall system instability is physically due to the individual 
experiment’s controllers being too reactive to the platform base-motions induced by each 
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Figure 5.5 Closed-Loop Simulation Results for the Case 2 
Configuration (5.5) Showing De-stabilization 
Phenomena Caused by Experiment Controllers 
Being Too Stable:(a) e^t), (b) 0 2 (t) [Results 
corn’d in Fig. 5.6]. 
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experiments’ motions 0j(t). In particular, it appears that the integral-terms in the 
experiments’ PID controllers (5.1) are too reactive (i.e. respond too quickly) to the platform 
base-motion disturbances <p(t) in the Case 2 configuration. 

Of course, technically all the system parameters play some role in creating a condition 
of dynamic instability, but the experience gained in exercising the Case 1 and Case 2 
configurations seems to suggest that the controller gains associated with the integral-terms 

of the PID controllers (5.1) are the primary determinants of the observed instability. For 
example, if the integral-term gains k^ in (5.1) for each experiment controller are set to zero, 
while in the Case 2 configuration (5.5), the system once again becomes stable. In that case, 
the local experiment controllers have only two (2) closed-loop poles each. However, if the 
remaining (P£>.) gains (lq^ k^) in (5.1) are then re-adjusted to place those 2 experiment 
controller closed-loop poles at k 1 =A, 2 = -4.0 (for each experiment), it was observed that the 
system instability reappeared. 

5.4 An Analytical Approach to the Analysis and Prediction of Conditions that Cause 

MPMSP System Instability 

The stable and unstable performances experimentally observed in the closed-loop 
simulation studies of Cases 1 and 2 in (5.4), (5 .5) as described in the preceding two sections 
can, in principle, be studied analytically by linearizing the "exact" nonlinear system model 
(4.1) and employing the classical Routh/Hurwitz stability conditions on the resulting linear, 
constant coefficient model [with the linear platform controller (3.32), (3.37), (3.45) and linear 
experiment controllers (5.1) installed]. In this way one can develop a set of simultaneous, 
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algebraic inequalities (involving the various controller gains and system parameters) that 
define the necessary and sufficient conditions for overall stability of the MPMSP system. 
This would permit a more definitive assessment of the precise conditions, among the system 
parameters, that trigger the on-set of controller-induced destabilization in this class of 
MPMSP problems. However, the set of algebraic inequalities so obtained will undoubtedly 
be rather large in number (>7) and will most surely be very complicated and nonlinear in 
structure. Consequently, the user "visualization" of the exact parametric stability conditions 
corresponding to those Routh/Hurwitz inequalities may be somewhat elusive. 

An attempt to develop the Routh/Hurwitz stability inequalities, using the 
aforementioned procedure, was initiated near the end of the period of performance for the 
present contract. However, the time available did not permit completion of that attempt. 
This is an important area for further study in any follow-on effort. 

5.5 Summary of Chapter 5 

The simulation studies described in this Chapter have verified that the proposed 
MPMSP disturbance-adaptive platform controller (3.32), (3.37), (3.45) can, in principle, 
achieve <p(t) « 0 while identifying and adapting to the kind of persistent, complex 
disturbances induced by the motions e^t), 0 2 (t) of experiment equipment mounted on the 
platform. The simulations have also revealed that even with the platform controller 
installed, the potential for the local experiment controllers in an MPMSP to begin "fighting" 
each other, and thereby triggering instability of the entire MPMSP system, as described in 
Chapter 1 of this report, is very real . In fact, it appears that this instability liability will exist 


UAH / ECE Dept. / Dr. C. D. Johnson 


14 


Chapter 5, Final Report 



A Multiple Pointing-Mount Control Strategy for Space Platforms 

NAiMtWS / D.O. 119 


for anv realistic form of platform controller. The challenge, therefore, is to understand the 
exact mechanism of this instability and to design the platform and experiment controllers 
(and other features of the MPMSP) to yield a comfortable margin of "overall system 
stability 1 ' under all operating conditions. 
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Chapter 6 

SUMMARY AND RECOMMENDATIONS FOR FURTHER WORK 

6.1 Summary nf Findings and Lessons Learned 

This study has revealed that the analytical modeling of the dynamics of a Multip 
Pointing-Mount Space Platform (MPMSP) is a surprisingly complicated task, even 
structural flexibilities are neglected and even if only planar rotational motions a 
considered. It appears that all of the traditional principles of classical dynamics are woefu 
inadequate for deriving the "exact" equations of motion for MPMSP-type systems. On ti 
other hand, the relatively new (circa 1968) method of dynamic modeling developed by Kai 
[8] appears to be ideally suited for rapidly deriving the exact equations of motion r 
MPMSP-type systems. Kanes’ method, as embodied in Levinson’s computer-aided modelii 
program. Autolev®, was used in this study to automatically derive the exact equations 
planar motion (4.1) for the generic MPMSP as shown in Figure 2.1. 

The principles of Disturbance-Accommodating Control (DAC). with son 
modifications, were used here to derive and demonstrate a new control concept fc 
stabilizing the platform motions 0(t) in the generic MPMSP model. This new platfor 
controller concept does not rely on the direct, real-time measurement of the "disturbanc: 
torques" induced on the platform by the respective experiment motions, but rather uses 
"disturbance-observer" to identify the resultant of those disturbance torques, in real-tim 
from measurements of only the platform motions 0(t). The resulting controller is abie : 
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quickly adapt to a rather wide variety of environment, equipment, and expenment-reiat 
uncertain, time-varying disturbances of the type that are expected in a realistic MPM 
project. 

In a typical MPMSP, the maintenance of a "quiet" platform (i.e. <p(t) « 0) is obviou 
essential for preventing one experiment’s motions from interfering with the precis 
pointing requirements of other (simultaneously acting) experiments. A not so obvious ft 
uncovered in this study, is that a sufficiently quiet platform is also essential for prevent 
the independent experiment controllers from "fighting" each other (overly reacting to 
disturbances that each experiment’s motions induce on the other experiments, via 
platform "base-motions") and thereby triggering an unexpected violent instability of 
entire MPMSP system. This overall instability tends to be counter-intuitive because it i 
occur even though the individual experiment controllers, and the platform controller, are 
very stable. In fact, experimental evidence developed in this study suggests that the ove 
system instability tends to occur because the individual experiment controllers are too sta: 
(i.e.. the experiment controllers have their individual closed-loop poles too deep in the 1 
half plane) and are thus too responsive! 

It appears that for any realistic-type platform controller (including the one develo: 
here) there will always exist a set of (seemingly stable) experiment controller parameters t 
will, in fact cause instability of the overall MPMSP system. The through understanding 
this phenomena, and steps one can take to assure it does not occur, should be a major fac 
of concern in any planned MPMSP design. 
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6.1.1 A Video Animation of the MPMSP Destabi liratirm Phenomena 

A video tape recording of a computer-generated animation of the 3-link model. 
Figure 2.1, in closed-loop stable and unstable motion was prepared and provided to MSFC's 
Pointing Control Systems Branch, to illustrate this important feature. A description of that 
computer-animation program is presented in Appendix B of this report. 

6.2 Rftcmnwiendations for Further Work 

The analytical analysis and visualization of the parametric "mechanism of instability 
in an MPMSP system is considered highly important for the safe, effective design and gam- 
sizing of both experiment controllers and the platform controller. In any follow-on effort 
this topic should be addressed via the linearization/Routh-Hurwitz methodology outlined in 
Section 5.5 of this report. 

The platform controller designed herein was based on the worst-case assumption of 
having access to only the one measurement 0(t). Further studies should consider cases in 
which one has access to , say, platform rate and acceleration measurements <f>( t), <p(i) and 
to direct measurement of, say, the controlled torques Tj(t), T 2 (t) exerted by the individual 
experiment controllers. Such considerations may result in reduced complexity and enhanced 
performance of the new platform controller proposed here. 
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Auto/ev-Generated Fortran Code for Simulation 
of the 3-Link "Exact" Model 
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n o r 1 


THE NAME OF THIS PROGRAM IS DAC3L. FOR 
CREATED BY AUTOLEV ON 06-03-1992 AT 07:12:5= 


IMPLICIT DOUBLE PRECISION (A-Z ' 

I NTEGER JLOOP . NSTEPS . NCUTS . NEDS . ILOOP . COUNTER . NPSTE- 
LOGICAL STPSZ 
EXTERNAL EONS 
CHARACTER MSG (75) 

DIMENSION U ( 17) 

COMMON/CZEES/Z (45) 

COMMON/CPAR/JO , J1 , J2,M0,M1 , M2 , PI , DEGTORAD . RADTODEG . LO 1 .LCD. LI .. 

L2 , KL 1 , KLO , KR2 , KR 1 ,KRO, CENTER 1 ,AMP1 , OMEGA 1 , CENTER2 . AMP2 . OMEGr 
COMMON/ CONT / W , W 1 , W2 , THE 1 SP , THE2SP 

COMMON/DFQLST/T , STEP , RELERR , ABSERR , NCUTS , NEQS .STPSZ 

OPEN ( UN I T= 1 1 , F I LE= * DAC3L .IN * , STATUS= ' UNKNOWN ' ) 

OPEN <UNIT=12,FI LE= ' DAC3L . 0U1 ' , STATUS= ' UNKNOWN ' ) 

OPEN (UNIT=13,FILE= ' DAC3L. 0U2 ' , STATUS= ' UNKNOWN ' ) 

OPEN ( UN I T= 1 4 , F I LE= ' DAC3L . 0U3 ' , STATUS= ' UNKNOWN ' ) 

OPEN (UNIT=15,FILE= ' DAC3L . 0U4 ' , STATUS= ' UNKNOWN ' ) 

OPEN < UN I T=2 1 , F I LE= ' D AC3L . H ST ATUS= ' UNKNOWN ' ) 

OPEN ( UN I T=3 1 , F I LE= ' DAC3L .001'. STATUS= ' UNKNOWN ' ) 

PI = 4 . ODO*DAT AN ( 1 . ODO ) 

DEGTORAD = PI /ISO. ODO 
RADTODEG = 1 . ODO/DEGTORAD 
WRITE (*,6001) 


* 

* 

*- 

* 


NOTE REGARDING INPUT AND OUTPUT DATA FILES 

The user must supply an input data -file to this program. The 
■file must be named FILENAME. IN , where FILENAME is obtained ^ror 
the -first line of this program. The data must be arranged ir 
accordance with the READ statements that immediately follow 
NOTE. 




n amez 


¥- 

■* 

*- 

* 

*- 


■* 

«► 

*- 


data files wnose 
each run. The first 
contains the time- 7. 

TMAX . PSTEF . 
runtime. STE^ 
that snoula de 
terminal ai sc 
Th 1 s messaae 


The output from the program is sent to 
appear on the screen at the completion of 
column in each output data file 

running from zero to TMAX in increments of PSTEF. 
and STEF are input from the terminal by the user at 
being the initial integration stepsize, a numoer 
chosen to be less than or equal to PSTEF. The 

prompts the user for a message identifying the run. 
is printed on each of the output files. Output files encinc 
in . OUn contain 1 1 me— hi stor 1 es of generalized soeeas anc 

generalized coordinates; files ending in .NRG contain kinetic 
energy, potential energy, and total energy ti me— ni stor 1 es : - : iIse 

ending in .H contain angular momentum 1 1 me— hi st or 1 es ; files encino 

in . Cun contain 1 1 me— n i stor 1 es of auanti ti e= apoearinc e.z 

arguments in CONTROLS commands; files endinc in . SPn 
time-mstories of SPECIFIED variables; and files enaing 
contain t l me— m st or i es of force and/or torque measure 
cor r esoond l ng to AUXILIARY generalized speeds. 


con t a i 
i n . AUr 
numoer - 


ORIGINAL PAGE 

OF POOR QUALITY 



READ <11 .*) LO 1 . LOI . i_ 1 . _2 . KL2 . KL 1 . KLO . KR2 . KR 1 . KRO . CENTER i . AMR : . 
■v A 1 . CENTER'D . AMP2 . OMEGA2 
READ (11 . * i MO. Ml. M2 
READ ill,* 1 J O 
READ (11 .*■> Jl 
READ 'ill ,*) J 2 

READ <11 , * ) U < 1 ) , U < 2 ) . U < 3 ) . U < 4 ) . U < 5 ) 

READ < 1 1 . *) PHI . THETA 1 , THETA2 , PHI ABSINT , PHI I NT 1 , THE 1 I NT , THE2 1 N“ 
2 . XC2,Z01 , Z02.Z03 

C 

C 

WRITE <* ,6002) 

READ ( * ,6003) < MSG < I LOOP ) , I LOOP = 1.75) 

WRITE <■* ,6009) 

READ < * , * ) TMAX , PSTEP . STEF'O 

NPSTEP = ID I NT < < PSTEP- 1 . D-B) /STEPO •*- 1) 

STEP = PSTEP /NPSTEP 

W 

WR I TE ( * ,6012) 


WR I TE < * ,6010) 
WR I TE (12,6101) 

(MSG (I LOOP) , ILOOP 

= 

1 ,75) 

WRITE <12,6010) 
WRITE < 13,6102) 

(MSG (I LOOP) , ILOOP 

= 

1,75) 

WRITE (13,6010) 
WR I TE (14,6103) 

(MSG (ILOOP) , ILOOP 

= 

1 ,75) 

WRITE< 14,6010) 
WRITE (15,6104) 

(MSG (ILOOP) , ILOOP 

~ 

1,75) 

WRITE (15,6010) 
WRITE (21 ,6151 ) 

(MSG (ILOOP) , ILOOP 


1,75) 

WRITE (21,6010) 
WRITE (31, 6201) 

(MSG (ILOOP) , ILOOP 

= 

1,75) 

WRITE (31 ,6010) 

(MSG (ILOOP) . ILOOP 

= 

1,75) 


WR I TE < * ,6011) 
WRITE < 12.601 1 > 


WRITE < * , 6500 ) LO 1 . L02 , LI , L2 , KL2 , KL 1 , KLO , KR2 , KR 1 , KRO . CENTER 1 , A' 
& OMEGA 1 , CENTER2 , AMF’2 . 0MEGA2 

WRITE <12, 6500 ) LOI. L02 , L 1 , L2 , KL2 . KL 1 , KLO , KR2 . KR 1 , KRO . CENTER 1 . A ■ 
2 OMEGA 1 , CENTER2 . AMP2 . 0MEGA2 


WRITE <■* ,6512) 

JO 

WF: I TE (12, 65 1 2 ) 

JO 

WRITE ( * ,6513) 

Jl 

WRITE (12, 651 3) 

Jl 

WRITE<* ,6514) 

vJ -I 

WF: I TE (12, 65 1 4 i 

J 2 

WR I TE ' 1 660u > 

MO . M 1 . M2 

WRITE \ 12 , 6600 i 

MO .Ml. M2 

WRITE f - . tot-u 1 

U ( 1 ) . U ( 2 ) .0 (3) .Li (4) , U (5 

WRITE (12, 660 1 .) 

U ( 1 J . Ll ( 2 ; , U ( 3 ) . L ( 4 > .LAC > 

WRITE < *■ , ob02 1 

PHI , THETA 1 . THET A2 . PH I ABS I NT . PHI I NT: 

-xoi.xo2.zq: 

, Z02.ZC3 

WR I TE (12. o6U2 1 

PHI . THETAi . THET A2, PH I ABSINT . PHI INTI 


OF POOS QUALITY 


. XQ1 . XC2, Z01 , Z02 . Z03 
WRITER .6006) TMAX . PSTEF' . STEP . STEF'O 
WRITE < 12.6006) TMAX , PSTEP , STEP , STEPO 

U < 6 > 

li ■: - 

u ( e > 

U ( 9 > 

U ( 1 0 ) 

LI ( 1 1 ) 

U < 12) 

U < 1 3) 

U < 1 4 ) 

U (15) 

U < 1 6) 

U ( 1 7 ) 

WRITE (* ,6007) 

WRITE (21 ,6007) 

WRITE (12,6701) 

WRITE (13,6702) 

WRITE (14,6703) 

WRITE (15,6704) 

WRITE (31 ,6751) 

NEQS 
NCUTS 
T 

RELERR 
ABSERR 
STPSZ 
NSTEPS 

COUNTER = O 


= 17 
= 20 
= 0 . 0 
= l.OD-B 
= l.OD-B 
= .FALSE. 

= ID I NT (TMAX/STEP+O. 1 ) +1 


= PHI 

= theta: 

= THETA2 

= PHI ABSINT 
= PH I INTI 
= THE 1 I NT 
= THE2INT 
= X01 
= X02 
= Z01 
= Z02 
= Z03 


DO 1000 JLOOP = 1 , NBTEPS 

CALL ZEES (T , U) 

IF (COUNTER. ED. NPSTEP. OR. COUNTER. ED. 0) THEN 
CALL ANGMOM ( T , U , HN 1 , HN2 , HN3 . HN ) 

WRITE (21,6005) T ,HN1 , HN2 . HN3 , HN 
WRITE <•* ,6005) T.HN1 ,HN2,HN3,HN 
WRITE ( 12,6005) T,U ( 1 ) ,U (2) , U (3) ,U (4) ,U (5) 

WRITE < 13,6005) T,U<6) ,U(7) ,LK8) ,U(9) ,U<10) 
WRITE < 14.6005) T,U(U),U(12),U(13).U(14),U<15) 
WRITE (15.6005) T ,U ( 16) , U ( 17) 

CALL CNTRL ( T . U ) 

WF: I TE ( 3 1 , 6005 ) T , W « W 1 , W2 , THE 1 = = . THE2SP 
COUNTER = 0 
END IF 

COUNTER = COUNTER •+■ 1 
I" (JLOOP. EQ.NSTEPS) 60 TO i 000 
CALL DEQS(EQNS.U.*99i 



1000 CONTINUE 


WRITE (*,6999) 


STOP 

= =? WRITE .6004 : 


eOO 1 


6002 

©003 

6004 

6005 

6006 


FORMAT (/IX, 'SYSTEM PARAMETERS AND INITIAL CONDITIONS 
2X , ' ARE NOW BEING READ FROM THE INPUT FILE' 
FORMAT < IX, ' INPUT A DESCRIPTION OF THIS RUN ' / ) 

FORMAT (75A1 ) 

FORMAT ( IX, 'STEPS I ZE HALVED TOO MANY TIMES'/) 

FORMAT ( 6 ( 1 X , 1 PE 12.5) ) 

FORMAT (1 IX, 'TMAX = ',1PE12.5,' S ' / 1 OX , ' PSTEP = .1PE12 

8, 'STEP = ' , 1PE12. 5 , ' S (USER INPUT VALUE = ',1PE12.5 

6007 FORMAT (//IX, 'SIMULATION RESULTS '/ /7X T 1 1 X HN 1 ', 1 OX 
$<HN3 ' , 10X, 'HN ' ,/6X , ' (S) ' ,BX, ' (N*M*S) ' ,6X , ' (N*M*S) ' ,6X , ' 
?, ' < N*M*S ) ' , / ) 

6008 FORMAT ( //IX, 'SIMULATION RESULTS '/ /7X , 'T' , 11X, 'KE' . 11X. 

PE' ,/6X, ' (S) ' ,SX, ' (UNITS) ' ,6X, ' (UNITS) ' ,6X. ' (UNITS) 

6 OOP FORMAT (/IX,' INPUT TMAX , PSTEP , STEP ' / 

S< 1 X 

TMAX : FINAL TIME 

PSTEP: TIME INTERVAL FOR PRINTING 

STEP : MAXIMUM INTEGRATION TIME STEP 


. * W 

, ' S ) 

, ' HN2 
<N*M*= 


PE ' 


dX , 


S<1X , 


/ 

/ ) 


&1X , 

?<1X, 

6010 FORMAT < 1 X ,' *** ',75A1) 

FORMAT (//IX, ' SYSTEM PARAMETERS ' / ) 

FORMAT ( 1 X ,' OUTPUT FROM PROGRAM DAC3L. FOR ' / / ) 

(OUTPUT FROM PROGRAM 
(OUTPUT FROM PROGRAM 
(OUTPUT FROM PROGRAM 
(OUTPUT FROM PROGRAM 
(OUTPUT FROM PROGRAM DAC3L. FOR ) ' 
(OUTPUT FROM PROGRAM DAC3L . FOP 
= , 1PE12. 5. m ' : 

/' 1 2 X . ' KL2 = , 1PE; 

KLO = ■ . 1PE12. 5. ' 

,1 PE 12. 5.' UNITS 


601 1 
6012 
6101 
6102 

6103 

6 1 04 
6151 
620 1 
6500 


FORMAT (IX, 
FORMAT ( IX , 
FORMAT (IX, 
FORMAT (IX, 
FORMAT (IX, 
FORMAT ( IX , 
FORMAT ( 12X 
= ' , 1PE12 


'FILE: 

DAC3L. 0U1 

'FILE: 

DAC3L.0U2 

'FILE: 

DAC3L. 0U3 

'FILE: 

DAC3L. 0U4 

'FILE: 

DAC3L. H 

'FILE: 

DAC3L. C01 

, ' LO 1 

= ' , 1 PE 12. 


DAC3L. FOR: 
DAC3L . FOR 
DAC3L . FOR 
DAC3L. FOR 


M ' / 1 3 X . 'LI 


5, ' M ' / 12X , ' L02 
= ' , 1PE12.5, ' M 

&UNITS'/12X, 'KL1 = , 1 PE 12. 5 , UNITS '/12X, 

S</ 1 2X , ' KR2 = ' , 1PE12. 5 , UNITS ' /12X , 'KR1 = 


5'KRO = ' , 1 PE 12.5, ' UNITS ' /BX , 'CENTER 1 = ,1PE1! 


i,l = ' , 1PE12. 5, ' UNITS ' /9X, '0MEGA1 = ',1PE12.5, 


5, ' UNITS ' /I 1 
UNITS ' /BX , 'C 


& = ' , 1PE12.5, 

' . 1PE12.5, 


UNITS'/llX, 'AMP2 = , 1PE12. 5 , UNITS ' /9X , ’ OME 


6512 

6513 

6514 
6600 


UNITS 1 

/ ) 


JO = ■ 

, 1PE12.5, ' 

KG*M^2 ' / ) 

J1 = ' 

, 1PE12.5, ' 

KG*M^2 ' / ) 

J2 = ' 

, 1PE12.5, ' 

KG*M^2 1 /) 

MO = ' 

. 1PE12.5, ' 

KG V13X, ' M 1 


1PE12. 


KG 


KG' / / ' 


FORMAT ( 13X , 

FORMAT ( 13X , 

FORMAT ( 13X , 

FORMAT ( 13X , 

K = , 1PE12. I 

©601 FORMAT (/IX, ' INITIAL CONDITIONS 
S<0X,'U2(0) = . 1 PE 12.5, ' RAD/S' 

K . ' U4 (0) = .1 PE12. 5 . M/S ' / 1 OX 

o602 FORMAT <9X. ' PHI (O’ = . 1 PE12. 5 . 

i<AD / 6 X . ' THET A2 ( 0 ' - .1 PE 12. 5. 

5. UNITS V5X. ’PHI INTI (0> = ' , 1PE12.5. ' UNITS /5X . ’ THE 1 I NT ( 

•®:E 12.5. ' UNITS ' /5X .' THE2INT (0) = .1PE12.5. UNITS' /9>;. ' XO 


//10X , 'U1 (0) 
1 OX . ' U3 ( O 1 = 


R* 

RAD 


' U5 ( 0 ) = 
RAD / 6 X 
RAD ' / 3 X 


. 1 PE 12.5 
. 1PE12.5. 

,1 PE 12. 3. M/E ■ 

' THETA 1 (O'- =• , 1 PE 1 

’ PHI ABB I NT ( 0 ) = .1 


CRMiMAl. 

OF POOR QUA1STY 



S' 1 PE 12. 5, RAD ' /9X , ' X02 <0) = . 1 PE 12. 3. RAD ' /*?X , '201 <0 > = 

.*.5, ' RAD ' /9X , ' Z02 (0) = ' . 1PE12.5. ' RAD ' /9.X , ' Z03 <0 i = .1PE12. 

S' Ei ' / / i 

.-,70 : FORMAT < / / IX. 'SI MULAT I ON RESULTS ' •' /7X . ' • . 1 1 X , ’ U1 ‘ . 1 1 X . L'_ . 1 

0 . 1 1 X . ‘ UA . 1 1 X . 'US . / 6X , ( S ) . S X . ( RAD /S . 6X . ' (RAD / E . a 

S . 7X . (M/Si ' .ex . ' (M/S) ./) 

e>7C2 FORMAT ( // 1 X . 'SIMULATION RESULTS ' ■ <'7X 1 X . ' PH I . SX . '' -iS~- 

0 'THETA2 ,fi»X . 'PHIABSINT ' .5X, 'PHIINT1 . /oX, ' (S) ,9X. (RAD . Z: 

S'.) ' ,BX. ' (RAD) ' ,7X , ' (UNITS) ' .6X. ' (UNITS) ' ./) 

6707 FORMAT (//IX . 'SIMULATION RESULTS '/ /7X T ', 9X ,' THE1 1 NT .6X. T-;. 

Sc.BX. ' X01 ' ,10X, ' X02 ' ,10X, *Z01 ',/6X, ' (S) ' ,BX, ' (UNITS) .6X , (UN 
S'7X. (RAD) ' ,BX, ' (RAD) ' ,8X, ' (RAD) ' ,/) 

6704 FORMAT (//IX, 'SIMULATION RESULTS ' //7X , 'T' ,11X, ' ZC2 ' , 10X. 'ICC 
S'(S) ' ,9X , ' (RAD) ' ,8X , ' (RAD) ' ,/) 

6751 FORMAT (//IX, 'SIMULATION RESULTS ' //7X , ' T ' , 12X , ' W ' , 1 1 X , ' W1 ’.11 
St , 9 X , 'THE1SP ' ,7X, ' THE2SP ' ,/6X, ' (S) ' ,9X, ' (N*M) ' ,7X, ' (UNITS .= 
S< ITS) ' ,6X, ' (UNITS) ' ,6X, ' (UNITS) ' ,/) 

6999 FORMAT ( //I X , 'OUTPUT IS ON FILES: ' , ' DAC3L. 0U1 ' /22X . ' DACOL. C 

S-:X, ' DAC3L. 0U3 ’ /22X , ' DAC3L. 0U4 ' /22X , ' DAC3L . H ' /22X , ' DAC3L. GDI 
END 


car*:*'/, r- 

OF 



SUBROUT I NE EONS < T . U . UDO” • 

IM c ‘LlOI~ DOUBLE PRECISION *4-Z 
D I MENS I ON U < IT) . UDOT • 1 " * . COE- ( 5 , 5 ) . RHB 5 

COMMON/ C ZEES/ Z <45 ' 

COMMON / CP AR / J 0 , J 1 .02 .MO .Ml . M2 . PI .DEBTOR AD . RADTODta -i ■ <- - •_ 

L2.KL1 .KL0.KR2.KR1 .KRO. CENTER 1 ,AMP1 . OMEGA 1 . CENTER- . AMP2 . OMEb 
COMMON / CONT / W , W 1 , W2 , THE 1 SP , THE2SP 


CALL ZEES (T , U) 

C 

PHI = LI ( 6 ) 

THETA 1 = U(7) 
THETA2 = U<8> 

PHI ABSINT = U<9) 
PHI INTI = U(10) 
THE 1 I NT = U < 1 1 > 
THE2INT = U < 1 2 > 
XOl = U < 13) 

X02 = U ( 1 4 ) 

ZOl = U < 1 5 ) 

Z02 = U (16) 

Z03 = U < 17) 

c 

c 

CALL CNTRL ( T , U ) 

C 


COEF (1,1) 

= 

Z (27) 

COEF (1,2) 

= 

-Z ( 28 ) 

COEF (1 .3) 

= 

-Z (2?) 

COEF (1 .4) 

= 

Z (30) 

COEF ( 1 .5) 

= 

Z ( 3 1) 

COEF (2. 1 > 

= 

-Z (29) 

COEF (2.2) 

= 

-Z (33) 

COEF (2,3) 

= 

0 . 0 

COER (2.4) 

= 

Z (34) 

COEF (2.5) 

= 

-Z (35) 

COEF (3, 1 ) 

= 

-Z ( 29 ) 

COEF (3.2) 

= 

0 . 0 

COEF (3.3) 

S= 

-Z (37) 

COEF (3,4) 

- 

-Z (38) 

COEF (3, 5) 

= 

Z (39) 

COEF (4, 1 ) 


Z ( 30 ) 

COEF <4. 2) 

= 

Z (34 j 

COEF (4.3* 


-I ( 38 ) 

COEF (4.4; 


“ Z ( 4 1 i 

COEF (4.5* 

= 

0 • 

COEF (5. 1) 

rr 

Z \ 3 1 ; 

COEF (5.2) 

= 

-* / TC- 

COEF (5. 3) 

=r. 

Z (3° • 

COER (5.4 > 

— 

0 • -< 

COER (5. 5' 

=r 

- Z <41 


ORIGINAL PAQC & 
OF POOR QUALITY 



n n on on no n n on on no no no 


RHS ( 1 

1 =: — lu-t- 2 (32* 

RHS ( 2 

i = — Wl— Z (36 ' 

RHS (3 

= -W2-Z(40' 

RHS (4 

i = Z '42. 

RHS (2 

:: - : (43: 

CAL,. 

UNOUF’L ■: 5 . COEF . RHS , UDOT 


Ue IS DEFINED TO 
UDOT (6) = U(l) 

BE 

PHI 

U7 IS DEFINED TO 
UDOT (7) = U ( 2 ) 

BE 

THETA 1 

US IS DEFINED TO 
UDOT (8) = U (3) 

BE 

THETA2 


Li 9 IS DEFINED TO BE RHIABSINT 
UDOT ( 9 ) = ABS <PHI ) 

UlO IS DEFINED TO BE PHI INTI 
UDOT < 10) = PHI 

Ull IS DEFINED TO BE THE1INT 
UDOT (11) = THE 1 SP-THET A 1 

U12 IS DEFINED TO BE THE2INT 
UDOT (12) = THE2SP-THETA2 

U13 IS DEFINED TO BE XD1 
UDOT (13) = X02+25. * (PHI-X01 ) 

U14 IS DEFINED TO BE X02 

LJD0T(14 > = Z 0 1 / J 0+W / J 0+250 . * ( PH I - X 0 1 

U15 IS DEFINED TO BE Z01 

UDOT (IS) = Z02+1250. *J0* (PHI— X01 ) 

U16 IS DEFINED TO BE Z02 

UDOT ( 16 i = Z03+3125. *J0* (PHI-XOl ) 

U17 IS DEFINED TO BE Z03 
UDOT (17) = 3125. *J0* (PHI-XOl) 


RETURN 

end- 


original PAGE '3 

OF POOR QUALITY 



1 . 


SUBROUT I NE UNCUPL ( WD I M . COE- . RHS . , JDO' r 
IMPLICI” DOUBLE PRECISION 
INTEGER NDIM. I PS <50 

D I MENS I ON COER < ND I M • ND I M ) . RHS < ND 1 M • 


i inr 


(NDIM 


CALL DECMP2 (NDIM. COEF . NDIM. COEF . IPS . . *902 
q^LL SOLVES ( ND I M . COEF . ND I M , RHS , UDO i . I F S 1 


RETURN 


C 


901 

902 

601 

602 


WRITE (*,601 ) 
STOP 

WRITE (*, 602 ) 


FORMAT (/IX, 'ALL ELEMENTS IN A ROW OF COEF ARE ^.EROS 
FORMAT (/IX, 'A PIVOT ELEMENT ENCOUNTERED IN THE DECOMPOS 
• OF COEF IS ZERO') 


TIO 


END 



I J U U U U U 


SUBROUT I ME ZEES < i .LI- 

IMPLICIT DOUBLE PRECISION (A-Z) 

DIMENSION U ( 1 7 > 

COMMON / CZEES / Z < 4 5 ) 

COMMON/ CPAR/J 0 . J 1 . J 2 . MO .Ml , M 2 . PI .DEBTOR AD , RADTODEG . LO 1 ------ 

L 2 .KL 1 . KLO , KR 2 , KR 1 .KRO, CENTER 1 ,AMP 1 . OMEGA 1 . CENTERS . AM C 2 . QMS 


PHI = U ( 6 i 
THETA 1 = Li (7) 
THETA2 = U ( B ) 

PHI ABSINT = U (9) 
PH 1 1 NT 1 = U < 1 0 > 
THE1INT = U Cl 1 ) 
THE2INT = Li (12) 
XOl = U ( 1 3 > 

X02 = LI (14 ) 

ZOl = U < 1 5 ) 

Z02 = U ( 1 6 ) 

Z03 = LI (17) 


C 


SI = DS IN (THETA 1) 
Cl = DCOS ( THETA 1) 
B2 = DSIN (THETA2) 
C2 = DCOS (THETA2) 


Z ( 1 ) 

Z ( 2 ) 

Z ( 3 ) 

Z ( 4 ) 

Z ( 5 ) 

Z (6 > 

Z ( S ) 

2 (9 > 

Z ( 1 0 ) 
2 < 1 1 * 
Z ( 1 2 > 
Z ( 13 ) 
Z < 1 4 > 
Z ( 1 5 ) 
Z < 1 6 > 
Z ( 1 7 ) 
Z < 1 S ) 
Z ( 1 9 ' 
Z ( 20 i 
Z ( 2 1 > 


Z ( 

: ( 


"•5 1 


L \ — L 


= L01*S1 
= C 1*L01 
= Ll+Z (2) 

= L02*S2 
= C2*L02 
= L2+Z (5) 

= U< 1 > *U (5) 

= U ( 1 > *U < 4 i 
= C1*L01*U<2) 

= L01*S1*U(2) 

= Cl *U <4 > +S 1 *U (5 ) +U ( 1 > *1 ( 1 ) 

= C1*U(5)+L1*U(2)-S1*U<4)+U(1 )*Z (3) 

= U ( 1 ) +U ( 2 ) 

= C1*U (5) -S1*U (4) 

= U(1)*Z(9)+U(2)*Z<14)-Z<12)*Z<13) 

= C1*LK4 » +S1*U (5) 

= U ( 1 ) *2 < 10) -*-U <2> *Z < 16) -Z ( 1 1 ) *Z < 13) 
= C2*L02*U<3) 

- L02*S2*U (3 ) 

= C 2 *U < 4 1 -S 2 *U ( 5 > -U ( 1 ) *Z < 4 ) 

= C2*U ( 5 > — L2*U ( 3 '< -S2*U < 4 ) -U ( 1 .» *Z < e ) 
= U ( 1 > +U ( 3 
= C2*U ■: 5 > — S2*U ( 4 : 

- u ( 1 1 +- Z ( 1 S » — U ( 3 ) * Z ( 23 1 + Z ( 2 1 > * I ( 22 ' 
= C2-*MJ < 4 > -t-S2*U ( 5 ■ 

- U \ 1 1 * I >: 1 9 « — U ( 3 > *■ 1 ( 25 ) + Z ' -0 > *■ 1 ’.22 


ORIGINAL ?.3GE H 

OF POOR QU&LsTV 


Dr. 



- (:.)+- / k I 


\ 


S. ri 1 *+■ l ( u I* z ( 4 1 — Z ( & > ■* - ^ 


> * r>1 1 ■ 
» -* M 1 


k , C 2 * l 
; 12* Z 

» * r-i i «+• 


: 4 > — S2* Z \ c • > 
t 6 » -»-S2*Z v - J 1 *M1 


i : ( 24 > 


( 


1(28) = J i +L1 *M1 *Z ( 3) 

•* = J2+L2*M2*Z \ t 

: : r-. , -C1*Z (3 * -S!*Z 

( Z t 1 > * z ■ 1 5 > - 1 ' 

) = C1*L1*M1 

( 12) 

) = J2+L2*L2*M2 
L2*M2*S2 
C2-*L2*M2 
) = L2-*M2*Z<26> 

M0+M1+M2 

<-C^*Z <^4)-S2*Z (26) )*M2+(C1*Z(13)+S1*Z (17) )*Ml-MO* 
<-Cl*Z (17)+S1*Z (15) >*M1+(C2*Z(26)-S2*Z <24> ) *M2+M0* 
^ .j — C2*L2-L02 ) *M2+ ( C 1 *L 1 +LU 1 ) 1 ) /Z (41) 

( LI -*M1 *S 1 — L2*M2*S2 ) / Z (4 1 * 


.) 

) 

58) 

%9> 


1 ■! “■ 
i_ ■ 

2 (Z 

z r 

Z <3 

7 

4. 

Z ( 40 
Z <41 
Z (42) 
Z (43) 
Z < 44 ) 
Z <45 i 


RETURN 

END 


c }( mm \ 3.;t ^ 

of poor QLO;ir*> 


m m 



SUBROUTINE CNTRL(T.U) 

IMPLICIT DOUBLE PRECISION <A-Z ; 

DIMENSION U (IT, 

COMMON/CZEES/Z (45 ; 

COMMON/ CPAR/ JO , J 1 . J2 . MO . Ml . M2 . PI .DEBTOR AD . RADTODEG . LC 1 . L 
L2,KL1 , KLO , KR2 . K'R 1 .KRO, CENTER 1 .AMP1 , OMEGA 1 , CENTERS . AMP 
COMMON / CONT/ W , W1 . W2 , THE1 SP , THE2SP 

PHI = LI (6) 

THETA 1 = U (7) 

THETAS = U<8) 

PHI ABSINT = U <9 ) 

PHI INTI = U(10) 

THE1INT = U ( 1 1 ) 

THE2INT = Li (12) 

XOl = Li (13) 

X02 = U < 1 4 > 

ZOl = U < 1 5 ) 

Z02 = U < 1 6) 

Z03 = Li ( 1 7 ) 


51 = DS I N < OMEGA 1 *T ) 

Cl = DCOSC OMEGA 1*T) 

52 = DS I N ( OMEGA2*T ) 

C2 = DCOS < 0MEGA2*T ) 

W = -JO* (7. 0*U ( 1 ) +20. 0*PHI+24. C*PHI INTI ) -ZOl 

W1 = J 1 * (KL2* <— U (2) > +KL 1 * < THE1SP— THETA 1 ) +KL0*THE1 1 NT ) 

W2 = J2* (KR2* (-U (3) ) +KR 1 * < THE2SP-THET A2 ) +KR0*THE2 1 NT ) 

THE ISP = CENTER 1+AMP1*S1 

THE2SP = CENTER2+AMP2*S2 

RETURN 

END 


ORIGINAL r ;nr -s 
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o n 


SUBROUTINE ANGMOM (T . U . HN1 .HN2.HN3.HN) 

IMPLICIT DOUBLE PRECISION < A— Z '< 

DIMENSION UiP' 

COMMON /CZ EES / Z ( 45 * 

COMMON/CPAR/JO. Jl . J2«M0,M1 .M2. PI , DEGTORAD . RAD . UD._ 
, L2.KL1.KL0.KR2.KR1 .KRO, CENTER 1 . AMP 1 .OMEGA 1 .CENT 


PHI = U ( 6 ) 

THETA 1 = U (7) 
THETA2 = U (8) 

PHI ABSINT = U<9) 
PHI INTI = U < 1 0 ) 
THE1INT = U<11) 
THE2INT = U < 12) 
X01 = U < 13) 

X02 = U < 14) 

Z01 = U < 15) 

Z02 = U(l&> 

Z03 = U ( 17) 


C 


c 


51 = DSIN (THETA 1 ) 
Cl = DCOS (THETA 1) 

52 = DSIN (THETA2) 
C2 = DCOS (THETA2) 


ZH1 = U (4) *Z (45) -U <5)*Z (44) 

ZH2 = C1*L1+L01-Z (44) 

ZH3 = L 1 *S1 -Z (45) 

ZH4 = C1*Z ( 1 1 > -S1*Z ( 12) 

ZH5 = C1*Z (12)+S1*Z (ID 
ZH6 = ZH2*ZH5-ZH3*ZH4 
ZH7 = -C2*L2-L02-Z (44) 

ZH6 = — L2*S2— Z (45) 

ZH9 = C2*Z (20) -S2*Z (21 ) 

ZH1 0 = C2*Z (21 ) +S2*Z (20) 

ZH1 1 = ZH10*ZH7-ZHB*ZH9 
HN1 = 0.0 
HN2 = 0.0 

HN3 = J0*U(1)+J1*Z (13)+J2*Z <22)+M0*ZHl+Ml*ZH6+M2*ZHl 
HN = DSQRT (HN1*HN1 + HN2*HN2 + HN3*HN3 ) 


RETURN 

END 
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SUBROUTINE DECMF'2 (N . A , ID IM ,LU . IPS , * , ■* ) 

IMPLICIT DOUBLE PRECISION in-Z ’ 

INTEGER N . ID I M . IP'S (N ) .I.u .K. IP.KP.KPl . NM 1 . IDXPI - 
D I MENS I ON A ( I D I M . N .> . LU ( I D I M , N i . SCALES ( 1 00 ; 

ZERC'= l - ) • O 0 O 
DO 5 1=1. N 
I PS (I »=I 
R0WNRM=0. ODO 
DO 2 J=1 , N 
LU ( 1 1 J ) —A k I 9 ) 

R0WNRM=DMAX1 ( ROWNRM , DABS (LU ( I , J ) ) ) 

2 CONTINUE 

IF (ROWNRM. ED. ZERO) RETURN 1 
SCALES ( I ) = 1 . 0 / ROWNRM 
5 CONTINUE 
NM 1 =N— 1 
DO 17 K= 1 , NM 1 
BIG= 0 . ODO 
DO 1 1 I =k , N 
IP=IPS(I) 

SI ZE=DABS (LU ( IP.K) )*SCALES(IP) 

IF (SIZE. LE .BIG) SO TO 11 
BIG=SIZE 
IDXPI V=I 
11 CONTINUE 

IF(BIG.EQ. ZERO) RETURN 2 
IF ( IDXPI V.EQ.K) GO TO 15 
J = IPS <K) 

IPS (K> =IPS ( IDXPI V) 

IPS ( IDXPI V ) —J 

15 KP= I PS ( K ) 

P I VOT =LU ( KP • K ) 

KP1=K+1 

DO lo I =KP 1 , N 

I P= I PS ( I ) 

EM=LU ( IP.K) /PIVOT 
LU (IP. K > =EM 
DO 16 J*KP1.N 

LU ( IP , J ) =LU ( I P , J > — EM*LU (KP , J ) 

16 CONTINUE 
IT CONTINUE 

IF (LU ( IPS (N) . N) . ED. ZERO) RETURN 2 

RETURN 

END 
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SUBROUT I ME SOLVE!: * N . LL . 
IMPLICI" DOUBLE PRECISI 
I NTEGEF 1 . j . I P . I p : . I M : . NP 
D I MENS I OfJ LU ( I D I N . N > . B < N ; 
NP 3 =|\h- : 

x >: 1 ) =& ( I PS ( i ■ > 

DO 2 1=2. N 
IP- I PS < I > 

I M 1 = I — 1 

SUM=0 . ODO 

DO 1 J— 1 . IM1 

SUM=SUM+LU < I P , J > * X < J ) 

CONTINUE 

X ( I > =B < I P '» -SUM 

CONT I NUE 

X < |\J ) = X < N ) / LU ( I PS ( M ) . N ) 

DO 4 I BACK-2. N 
I -NP1 — IBACK 
IP- I PS (I ) 

IP1-I+1 
SUM-0 . ODO 
DO 3 J-IP1.N 
SUM-SUM+LU < I P , J ) * X < J > 
CONTINUE 

X < I ) = < X ( I ) -SUM ) /LU ( IP , I ) 

RETURN 

END 
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SUBROUT I NE DECS ■' F . . * i 

IMPLI2I - DOUBLE PRECISION >'A-C 
I NTEGE- I . f-iCL'Ts . NEC 

_ U I L A _ L’U . W T F w _ 

EXTERNAL =■ 

COMM 0 N / D F Q L S ~ . STEP . REu . ABB - NCUTS . NEC . STF’EC 

DIMENSION F 0 ( 200 ) . F l (200) . F2 ( 200 ; . y 2 (200.) , Y2 (200 ; , (NEC 
DATA HC/O.ODO 

C **■* CHECK FOR INITIAL ENTRY AND ADJUST HC . IF NECESSARY . 

I F < NEu . NE . 0 ) GO TO 1 0 

HC=STEP 

RETURN 

10 IF (STEP- EQ.O. ODO) RETURN 1 
C **■* CHANGE DIRECTION, IF REQUIRED, 

I F ( HC*STEP » 20 , 30 . 40 
20 HC--HC 

GO TO 40 
30 HC=STEP 

C **•* SET LOCAL VARIABLES 
40 EPSL=REL 
F I NAL=T +STEF' 

H=HC 
TT=T+H 
T=FINAL 
H2=H/2. ODO 
H3=H/3. ODO 
H6=H/6. ODO 
H8=H/S. ODO 

C *** MAIN KUTT A— MERSON STEP 

50 IF< (H.GT.O. ODO. AND. TT.GT. FINAL) .OR. 

C < H.LT.O.ODO. AND.TT.LT. FINAL) > GO TO 190 

60 CALL P < TT-H . Y . FO > 

Du 70 i = I .NEC 

T'j v 1 ( I i = P>.* ( I ) ■fcH S+ t ’ 1 ' 

CALL F < TT— 2 . 0*H3 , V 1 , F 1 
DO 80 1=1. NEC 

80 Y 1 ( I > = (FO ( I ) -+-F1 ( I ) > *Ho+V < I ) 

CALL F < TT-2 . 0*H3 . Y 1 .FI) 

DO 90 1 = 1. NEC! 

90 Y 1 (I > = (FI (I) *3. O+FO ( I ) ) *H8+Y ( I . 

CALL F \ TT— H2 . V 1 . F2 > 

DO 100 1=1. NED 

1 OU Y 1 ( I * =. ( FL! (I > *4 . (.*- P 1(1) *3 . O+FO ( I ) > +H2+Y ( I • 

CALL F(TT.Yl.Fl) 

DC 110 1=1. NEC 

1 10 Y2 ( I i = i ~2 ( I » +r4. 0+F 1 ( I > + F 0 ( I ) > *He + v ■' I . 

C *-■*■■*- DOES THE STEPS I ZE H NEED ^ TO E<E CHANGED - 

DBL= . TRUE . 

DO 1 60 :i = : . NEC 

ERR=DAB9 ' v I I • -Y2 ' I - * *■■■..: . 2 

T E S T = L* Li t E I ■ )+-E =: 'S'_ 

I~ ( ERF. - . TEE - . OR. ERF: . _T . AB5 * GC — C 13C 
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_■ HALVE THE STEPS I ZE 

H=H2 

TT=TT-H2 

IF ( . NOT. SM C 'SZ ! SO TO; 12 

TEMP=TT-H2 

WRITE > •»; . 200 '• H . TEM 1 "' 

- HAS the STEPS I ZE BEEN HALVED TOO MAN v TIMES - 

120 NCUT5=NCUT5-i 

IF ( NCUT5. GE . 0 > 60 TO 130 

T=TT-H2 

WRITE (*,210) T 
RETURN 1 

C *** IF STEPSIZE IS TOO SMALL RELATIVE TO TT TAKE RETURN 1 
130 IF(TT-t-H.NE.TT) GO TO 140 
T=TT 
RETURN 1 

140 H2=H/2. ODO 

H3-H/3.0D0 
H6=H/6. ODO 
H8=H/8. ODO 
GO TO 60 

1 50 I F ( DEL . AND . 64 . ODO*ERR . GT . TEST 

C . AND . 64 . ODO*ERR . GT . ABS ) DBL=. FALSE. 

160 CONTINUE 

C *** DOUBLE THE STEPSIZE, MAYBE. 

IF (.NOT. DEL. OR. DABS (2. ODO*H) . GT. DABS (STEP ) .OR. 

C DABS ( TT +2 . ODO*H ) . GT . DABS ( F I NAL ) .AND. 

C DABS (TT-FINAL) . GT. DABS (FINAL) *1 . 0D-7) GO TO 170 

H2=H 
H=H+H 

IF(STPSZ) WRITE (*,200) H , TT 
H3=H/3. ODO 
H6=H/6. ODO 
H8=H/B. ODO 
NCUTS=NCUTS+1 
170 DO 180 1=1. NEO 
180 V ( I > =Y2 ( I i 

TT=TT+H 
GO TO 50 

190 IF(EPSL.LT.O.ODO) RETURN 
C: *** NOW BE SURE TO HAVE T = F I NAL . 

HC=H 

H=FINAL- (TT-H) 

I F ( DABS < H ) . LE . DABS < F I NAL ) * 1 . OD-7 ' RETURN 

TT=FINAL 

EPSL=-1 . ODO 

H2=H/2. ODO 

H3=H/3. ODO 

He>=H / 6 . ODO 

H8=H/S. ODO 

GO TO o'. 1 

200 FORMAT < 1 a . ' THE STEPSIZE IS NOW , 1PD12.4. AT - = .!F2 

210 FORMAT (1;. 'THE STEPSIZE HAS BEEN HALVED TOO MAN v TIMES: 

: - = . 1 PD 1 2 . A 

END 
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